This work focuses on modeling and real-time control of a motion simulator for dynamic testing of a two-axis gyro-stabilized head mirror used in modern tanks. For this purpose, a six-degree-of freedom Stewart Platform which can simulate disturbances on the stabilized head mirror during operation of the tank is employed. Mathematical models of the Stewart Platform are constructed using MATLAB and ADAMS. Control system infrastructure is constructed and real-time control system elements are employed. Controller tuning is achieved by using the developed mathematical models in MATLAB. These parameters are applied in the real-time control system and fine tuning is achieved. Accuracy of the motion simulator is tested by mounting an Inertial Measurement Unit on the Stewart Platform. Further control system strategies are discussed by means of simulation.

Thesis (MScEng (Mechanical and Mechatronic Engineering))--University of Stellenbosch, 2011. / ENGLISH ABSTRACT: The world's astronomy community is working together to build the largest and most sensitive radio telescope in the world namely: the SKA (Square Kilometre Array). It will consist of approximately three thousand dishes which will each require accurate positioning. The Square Kilometer Array has a testbed called the Phased Experimental Demonstrator (PED) in Observatory, Cape Town. A hexapod positioning mechanism is required to position a 3.7 m radio telescope which forms part of an array of seven radio telescopes. This thesis details the design process of the hexapod system. The design consists of the mechanical design of the joints and linear actuators, a kinematic and dynamic model, a controller and a user interface. In order to verify the design for the PED hexapod a scaled prototype was designed, built and tested. The hexapod's repeatability as well as ability to track a path was tested using an inclinometer. The tests confirmed the design feasibility of the PED hexapod and also highlight issues that require care when constructing the full scale hexapod, such as the amount of play in the platform joints. The designed full scale hexapod will have an error angle less than 0.13°, a payload capacity of 45 kg, withstand wind speeds of 110 km/h and cost R160 000. / AFRIKAANSE OPSOMMING: Die wêreld se sterrekundige gemeenskap is besig om saam te werk om die grootste en mees sensitiewe radioteleskoop in die wêreld te bou, naamlik: die SKA (Square Kilometre Array). Dit sal uit ongeveer drie duisend skottels bestaan wat elkeen akkurate posisionering benodig. Die SKA het 'n toetssentrum, genaamd die “Phased Experimental Demonstrator” in Observatory, Kaapstad. 'n Sespoot posisionering meganisme word benodig om die 3.7 m radioteleskoop te posisioneer, wat deel vorm van 'n stelsel van sewe radioteleskope. Hierdie tesis beskryf die proses om die sespoot stelsel te ontwerp. Die ontwerp bestaan uit die meganiese komponent van die koppelings en lineêre aktueerders, 'n kinematiese en dinamiese model, 'n beheerder, asook 'n gebruikersintervlak. 'n Geskaleerde prototipe is ontwerp, gebou en getoets om die ontwerp te verifieer. Die platform se herhaalbaarheid sowel as akkuraatheid om 'n pad te volg was getoets met 'n oriëntasie sensor. Die toetse het probleme uitgelig wat versigtig hanteer moet word gedurende die konstruksie van die volskaalse sespoot, veral die hoeveelheid speling in die koppelings. Die volskaalse sespoot ontwerp het 'n hoek fout van minder as 0.13°, 'n ladingsvermoë van 45 kg en kan 'n windspoed van 110 km/h weerstaan en kos R160 000.

<p align="justify">Many different active control techniques can be used to control the vibrations of a mechanical structure: they however require at least a sensitive signal amplifier (for the sensor), a power amplifier (for the actuator) and an analog or digital filter (for the controller). The use of all these electronic devices may be impractical in many applications and has motivated the use of the so-called shunt circuits, in which an electrical circuit is directly connected to a transducer embedded in the structure. The transducer acts as an energy converter: it transforms mechanical (vibrational) energy into electrical energy, which is in turn dissipated in the shunt circuit. No separate sensor is required, and only one, generally simple electronic circuit is used. The stability of the shunted structure is guaranteed if the electric circuit is passive, i.e., if it is made of passive components such as resistors and inductors.</p> <p align="justify">This thesis compares the performances of the electric shunt circuits with those of classical active control systems. It successively considers the use of piezoelectric transducers and that of electromagnetic (moving-coil) transducers.</p> <p align="justify">In a first part, the different damping techniques are applied on a benchmark truss structure equipped with a piezoelectric stack transducer. A unified formulation is found and experimentally verified for an active control law, the Integral Force Feedback (IFF), and for various passive shunt circuits (resistive and resistive-inductive). The use of an active shunt, namely the negative capacitance, is also investigated in detail. Two different implementations are discussed: they are shown to have very different stability limits and performances.</p> <p align="justify">In a second part, vibration isolation with electromagnetic (moving-coil) transducers is introduced. The effects of an inductive-resistive shunt circuit are studied in detail; an equivalent mechanical representation is found. The performances are compared with that of resonant shunts and with that of active isolation with IFF. Next, the construction of a six-axis isolator based on a Stewart Platform is presented: the key parameters and the main limitations of the system are highlighted.</p>

Nos últimos anos, tem havido grande interesse em estudar manipuladores paralelos, aplicados principalmente em simuladores de voo, com seis graus de liberdade. O interesse em estruturas cinemáticas paralelas é motivado por sua alta rigidez e excelente capacidade de posicionamento em relação às estruturas cinemáticas seriais. Além disso, como os atuadores são posicionados em uma base, eles podem ser aplicados em cargas pesadas e ainda apresentam baixo consumo de energia, tendo em vista que vários atuadores atuam simultaneamente no mesmo corpo. A presente tese apresenta o projeto de três controladores, sendo eles, o controlador H infinito com realimentação de saída, o controlador PID e o controlador Fuzzy, com isto, esta metodologia poderá ser empregada na construção de um futuro simulador de voo. O modelo dos atuadores foi obtido através de uma entrada degrau de tensão nos motores, medindo os seus deslocamentos através dos encoders acoplados, individualmente, a cada um dos respectivos eixos dos motores. Sabendo-se a relação de transmissão do mecanismo de movimento entre o motor e cada haste dos atuadores obtém-se o deslocamento de cada haste a partir da rotação de cada motor medida pelo correspondente encoder e com isso obtém-se o modelo matemático de cada atuador em conjunto com seu sistema de transmissão. Entretanto, na prática, cada atuador é ligeiramente diferente dos outros, o que leva a comportamento e desempenho diferentes entre si. Isso afeta o comportamento da plataforma fazendo com que a trajetória final desejada não possa ser seguida adequadamente, algo que é extremamente necessário em simuladores de voo. Assim, uma das contribuições importantes deste trabalho é, em primeiro lugar, apresentar uma metodologia de padronização das respostas dos atuadores de modo a que todos eles tenham no final, um comportamento igual o mais próximo possível, particularmente em termos de velocidade e de posicionamento. Com os dados da cinemática e da dinâmica da plataforma compondo o modelo completo do sistema foram realizadas várias simulações que aplicadas na plataforma de Stewart real validaram o modelo e mostraram a eficiência das técnicas de controle aplicadas no controle de posição e orientação da plataforma. Para validar o projeto da Plataforma de Stewart como uma possível base de movimento de um simulador de voo, foi implementada a dinâmica longitudinal e lateral de um Boeing 747-100, e com o auxilio de um sensor inercial Xsens® MTi-G, foram realizadas as medições dos ângulos de Euler da Plataforma. Os resultados obtidos pelos três controladores foram satisfatórios e ilustram o desempenho e a robustez da metodologia proposta. / In recent years there has been great interest in studying parallel manipulators, mainly applied in flight simulators, with six degrees of freedom. The interest in parallel kinematic structures is motivated by its high stiffness and excellent positioning capability in relation to serial kinematic structures. Furthermore, since the actuators are positioned on a base, they can handle heavy loads and also have low power consumption, considering that several actuators act on the same platform. This thesis presents the design of three controllers, which are, H-infinity controller with output feedback, PID controller and Fuzzy controller, so that this methodology can be employed in building a future flight simulator. The actuators models were obtained by a step voltage input to the engines and measuring their displacements by the encoders that are coupled to each of the respective axes of the motors. Knowing the relation from the motion transmission mechanism between the motor and the spindle of each actuator, the displacement of each spindle is obtained from the rotation of each motor measured by the corresponding encoder and thus we obtain the mathematical model of each actuator together with its transmission system. However, in practice, each actuator is slightly different from others, which leads to different behavior and performance of each. This affects the behavior of the platform making the final desired trajectory cannot be properly followed something that is extremely necessary in flight simulators. Thus, one of the important contributions of this work is first to present a methodology to standardize the actuators responses so that they all have in the end a behavior equal a close as possible, particularly in terms of velocity and positioning. With the kinematics data and platform dynamics composing the complete system model, several simulations applied to the real Stewart Platform validate the model and show the effectiveness of control techniques applied to control the position and orientation of the platform. In order to validate the Stewart Platform design as a possible base for a motion flight simulator, the longitudinal and lateral dynamics of a Boeing 747-100 model were implemented, and with the aid of an inertial sensor Xsens® MTi-G, measurements of the Euler angles of the platform were performed. The results obtained by the three controllers were satisfactory and illustrate the performance and robustness of the proposed methodology.

Este trabalho apresenta o controle de posição e orientação de um modelo não linear de Plataforma de Stewart com seis graus de liberdade construído no ambiente de sistemas multicorpos ADAMS® desenvolvido pela Mechanical Dynamics, Inc. O modelo não linear é exportado para o ambiente SIMULINK® desenvolvido pela MathWorks, Inc., onde o controle de posição e orientação é realizado a partir da linearização do modelo e a aplicação de um sistema seguidor com realimentação de estados. Utililiza-se, também o SIMULINK® para implementar a dinâmica de um sistema servoválvula e cilindro hidráulico com um servocontrole de pressão e assim simular o comportamento dinâmico de um simulador de vôo com acionamento hidráulico. A utilização destes pacotes comerciais visa obter uma economia de tempo e esforço na modelagem de sistemas mecânicos complexos e na programação para obtenção da resposta do sistema no tempo, além de facilitar a análise de várias configurações de Plataformas de Stewart / This work shows the position and orientation control of a non-linear model of a Stewart platform with six degree of freedom developed in the multibody systems environment ADAMS® (Mechanical Dynamics, Inc.). The non-linear model is exported to SIMULINK® (MathWorks, Inc.), where the position and orientation control is accomplished using the linear model and applied as a tracking-system with state-feedback. The SIMULINK® is also used to implement the dinamics of the servovalve and hydraulic cylinder with pressure-control servo and so simulate the dynamic behavior of the flight simulator with hydraulic drive. These commercial packages are used seeking to save time and effort in the modeling of complex mechanical systems and in the programming to get the time response of the system, facilitating the analysis of several Stewart Platforms configurations.

Devido à dificuldade em se desenvolver um sistema de controle baseado no modelo da planta, principalmente quando a mesma possui diversos graus de liberdade, busca-se uma metodologia a fim de minimizar o tempo e os esforços para projetar o sistema de controle. A metodologia consiste na utilização de um software de sistemas multicorpos, para a geração do conjunto de equações que descrevem o comportamento dinâmico, a partir de características físicas do sistema, tais como: massa, centro de massa, momentos principais de inércia, dimensões dos elos e juntas com determinados graus de liberdade. Para determinação das características físicas, são utilizadas técnicas experimentais, procedimentos e instrumentação para identificação com acuracidade controlada dos centros de massa e dos momentos principais de inércia dos elos. Estes são considerados corpos rígidos não homogêneos, algumas vezes acoplados por juntas de movimento, não sendo possível desacoplá-los. O sistema de controle utiliza um sistema com realimentação de estados com observador, capaz de fornecer resultados satisfatórios. O observador é utilizado para diminuir o número de estados medidos, facilitando a instrumentação do mecanismo. Esses procedimentos podem ser aplicados à maioria dos sistemas multicorpos, com muitos graus de liberdade, a fim de se obter um sistema de controle com desempenho e acuracidade predefinidos, para serem implementados em sistemas de aquisição e controle flexíveis, ou através de hardwares dedicados. Para validar essa metodologia, esta será aplicada ao protótipo de uma plataforma de movimento que, por conveniência de projeto, teve seus graus de liberdade controlados limitados a dois. Seu acionamento dá-se por servomotores brushless, atuadores de fusos de esferas, utilizando-se sensores de posição linear por magnetostrição e angular ópticos. O fato do número de graus de liberdade ter sido reduzido a dois não invalida a metodologia, caso seja necessário aplicá-la a sistemas com qualquer número de graus de liberdade. / The difficulty to develop a control system based in the model of the plant, mainly when the plant has many degrees of freedom, motivated this work which presents a methodology to minimize the time and effort in developing the control system. The methodology consists on the use of a multibody systems software for generating the set of equations that describes the system dynamic behavior, starting from its physical characteristics such as mass, center of mass, principal moments of inertia, dimensions of the links and joints with certain degrees of freedom coupling the links. For the physical characteristics determination, experimental techniques, procedures and instrumentation are used to identify, with controlled accuracy, the links centers of mass and principal moments of inertia, being the plant considered formed by non homogeneous rigid bodies, sometimes coupled by joints of movement and not being possible to uncouple them. For the control system a state feedback control system with estimator is used, capable of suppling satisfactory results. An estimator is used to reduce the number of measured states facilitating the mechanism instrumentation. Those procedures can be applied to most of multibody systems with several degrees of freedom to obtain a control system with performance and accuracy previously defined to be implemented in a flexible acquisition and control board or dedicated hardware. To validate this methodology, it will be applied to a prototype of a movement platform, which, for project convenience had their controlled degrees of freedom limited to two. The platform is driven by brushless servomotors, has actuators with spindle bearings, using sensors of linear position by magnetostriction and angular by optical principle. The fact of the number of degrees of freedom being reduced to two doesn\'t invalidate the methodology in case it is necessary to apply it to systems with any number of degrees of freedom.

Devido à dificuldade em se desenvolver um sistema de controle baseado no modelo da planta, principalmente quando a mesma possui diversos graus de liberdade, busca-se uma metodologia a fim de minimizar o tempo e os esforços para projetar o sistema de controle. A metodologia consiste na utilização de um software de sistemas multicorpos, para a geração do conjunto de equações que descrevem o comportamento dinâmico, a partir de características físicas do sistema, tais como: massa, centro de massa, momentos principais de inércia, dimensões dos elos e juntas com determinados graus de liberdade. Para determinação das características físicas, são utilizadas técnicas experimentais, procedimentos e instrumentação para identificação com acuracidade controlada dos centros de massa e dos momentos principais de inércia dos elos. Estes são considerados corpos rígidos não homogêneos, algumas vezes acoplados por juntas de movimento, não sendo possível desacoplá-los. O sistema de controle utiliza um sistema com realimentação de estados com observador, capaz de fornecer resultados satisfatórios. O observador é utilizado para diminuir o número de estados medidos, facilitando a instrumentação do mecanismo. Esses procedimentos podem ser aplicados à maioria dos sistemas multicorpos, com muitos graus de liberdade, a fim de se obter um sistema de controle com desempenho e acuracidade predefinidos, para serem implementados em sistemas de aquisição e controle flexíveis, ou através de hardwares dedicados. Para validar essa metodologia, esta será aplicada ao protótipo de uma plataforma de movimento que, por conveniência de projeto, teve seus graus de liberdade controlados limitados a dois. Seu acionamento dá-se por servomotores brushless, atuadores de fusos de esferas, utilizando-se sensores de posição linear por magnetostrição e angular ópticos. O fato do número de graus de liberdade ter sido reduzido a dois não invalida a metodologia, caso seja necessário aplicá-la a sistemas com qualquer número de graus de liberdade. / The difficulty to develop a control system based in the model of the plant, mainly when the plant has many degrees of freedom, motivated this work which presents a methodology to minimize the time and effort in developing the control system. The methodology consists on the use of a multibody systems software for generating the set of equations that describes the system dynamic behavior, starting from its physical characteristics such as mass, center of mass, principal moments of inertia, dimensions of the links and joints with certain degrees of freedom coupling the links. For the physical characteristics determination, experimental techniques, procedures and instrumentation are used to identify, with controlled accuracy, the links centers of mass and principal moments of inertia, being the plant considered formed by non homogeneous rigid bodies, sometimes coupled by joints of movement and not being possible to uncouple them. For the control system a state feedback control system with estimator is used, capable of suppling satisfactory results. An estimator is used to reduce the number of measured states facilitating the mechanism instrumentation. Those procedures can be applied to most of multibody systems with several degrees of freedom to obtain a control system with performance and accuracy previously defined to be implemented in a flexible acquisition and control board or dedicated hardware. To validate this methodology, it will be applied to a prototype of a movement platform, which, for project convenience had their controlled degrees of freedom limited to two. The platform is driven by brushless servomotors, has actuators with spindle bearings, using sensors of linear position by magnetostriction and angular by optical principle. The fact of the number of degrees of freedom being reduced to two doesn\'t invalidate the methodology in case it is necessary to apply it to systems with any number of degrees of freedom.

Este trabalho apresenta o controle de posição e orientação de um modelo não linear de Plataforma de Stewart com seis graus de liberdade construído no ambiente de sistemas multicorpos ADAMS® desenvolvido pela Mechanical Dynamics, Inc. O modelo não linear é exportado para o ambiente SIMULINK® desenvolvido pela MathWorks, Inc., onde o controle de posição e orientação é realizado a partir da linearização do modelo e a aplicação de um sistema seguidor com realimentação de estados. Utililiza-se, também o SIMULINK® para implementar a dinâmica de um sistema servoválvula e cilindro hidráulico com um servocontrole de pressão e assim simular o comportamento dinâmico de um simulador de vôo com acionamento hidráulico. A utilização destes pacotes comerciais visa obter uma economia de tempo e esforço na modelagem de sistemas mecânicos complexos e na programação para obtenção da resposta do sistema no tempo, além de facilitar a análise de várias configurações de Plataformas de Stewart / This work shows the position and orientation control of a non-linear model of a Stewart platform with six degree of freedom developed in the multibody systems environment ADAMS® (Mechanical Dynamics, Inc.). The non-linear model is exported to SIMULINK® (MathWorks, Inc.), where the position and orientation control is accomplished using the linear model and applied as a tracking-system with state-feedback. The SIMULINK® is also used to implement the dinamics of the servovalve and hydraulic cylinder with pressure-control servo and so simulate the dynamic behavior of the flight simulator with hydraulic drive. These commercial packages are used seeking to save time and effort in the modeling of complex mechanical systems and in the programming to get the time response of the system, facilitating the analysis of several Stewart Platforms configurations.

Nos últimos anos, tem havido grande interesse em estudar manipuladores paralelos, aplicados principalmente em simuladores de voo, com seis graus de liberdade. O interesse em estruturas cinemáticas paralelas é motivado por sua alta rigidez e excelente capacidade de posicionamento em relação às estruturas cinemáticas seriais. Além disso, como os atuadores são posicionados em uma base, eles podem ser aplicados em cargas pesadas e ainda apresentam baixo consumo de energia, tendo em vista que vários atuadores atuam simultaneamente no mesmo corpo. A presente tese apresenta o projeto de três controladores, sendo eles, o controlador H infinito com realimentação de saída, o controlador PID e o controlador Fuzzy, com isto, esta metodologia poderá ser empregada na construção de um futuro simulador de voo. O modelo dos atuadores foi obtido através de uma entrada degrau de tensão nos motores, medindo os seus deslocamentos através dos encoders acoplados, individualmente, a cada um dos respectivos eixos dos motores. Sabendo-se a relação de transmissão do mecanismo de movimento entre o motor e cada haste dos atuadores obtém-se o deslocamento de cada haste a partir da rotação de cada motor medida pelo correspondente encoder e com isso obtém-se o modelo matemático de cada atuador em conjunto com seu sistema de transmissão. Entretanto, na prática, cada atuador é ligeiramente diferente dos outros, o que leva a comportamento e desempenho diferentes entre si. Isso afeta o comportamento da plataforma fazendo com que a trajetória final desejada não possa ser seguida adequadamente, algo que é extremamente necessário em simuladores de voo. Assim, uma das contribuições importantes deste trabalho é, em primeiro lugar, apresentar uma metodologia de padronização das respostas dos atuadores de modo a que todos eles tenham no final, um comportamento igual o mais próximo possível, particularmente em termos de velocidade e de posicionamento. Com os dados da cinemática e da dinâmica da plataforma compondo o modelo completo do sistema foram realizadas várias simulações que aplicadas na plataforma de Stewart real validaram o modelo e mostraram a eficiência das técnicas de controle aplicadas no controle de posição e orientação da plataforma. Para validar o projeto da Plataforma de Stewart como uma possível base de movimento de um simulador de voo, foi implementada a dinâmica longitudinal e lateral de um Boeing 747-100, e com o auxilio de um sensor inercial Xsens® MTi-G, foram realizadas as medições dos ângulos de Euler da Plataforma. Os resultados obtidos pelos três controladores foram satisfatórios e ilustram o desempenho e a robustez da metodologia proposta. / In recent years there has been great interest in studying parallel manipulators, mainly applied in flight simulators, with six degrees of freedom. The interest in parallel kinematic structures is motivated by its high stiffness and excellent positioning capability in relation to serial kinematic structures. Furthermore, since the actuators are positioned on a base, they can handle heavy loads and also have low power consumption, considering that several actuators act on the same platform. This thesis presents the design of three controllers, which are, H-infinity controller with output feedback, PID controller and Fuzzy controller, so that this methodology can be employed in building a future flight simulator. The actuators models were obtained by a step voltage input to the engines and measuring their displacements by the encoders that are coupled to each of the respective axes of the motors. Knowing the relation from the motion transmission mechanism between the motor and the spindle of each actuator, the displacement of each spindle is obtained from the rotation of each motor measured by the corresponding encoder and thus we obtain the mathematical model of each actuator together with its transmission system. However, in practice, each actuator is slightly different from others, which leads to different behavior and performance of each. This affects the behavior of the platform making the final desired trajectory cannot be properly followed something that is extremely necessary in flight simulators. Thus, one of the important contributions of this work is first to present a methodology to standardize the actuators responses so that they all have in the end a behavior equal a close as possible, particularly in terms of velocity and positioning. With the kinematics data and platform dynamics composing the complete system model, several simulations applied to the real Stewart Platform validate the model and show the effectiveness of control techniques applied to control the position and orientation of the platform. In order to validate the Stewart Platform design as a possible base for a motion flight simulator, the longitudinal and lateral dynamics of a Boeing 747-100 model were implemented, and with the aid of an inertial sensor Xsens® MTi-G, measurements of the Euler angles of the platform were performed. The results obtained by the three controllers were satisfactory and illustrate the performance and robustness of the proposed methodology.

Around 40 million people around the world have amputated parts of their bodies. Prostheses are widely used to support their daily behavior. However, about 35% of amputees refuse to use the prostheses due to comfort problems. SocketSense is an EU research project that aims to improve the situation. The Stewart platform (SP) is used as the model of the prototype. The SP could reproduce the comparing forces and torques interior the socket-to-stump interface, given prerecorded movement information of an amputee’s walk cycle. However, previous work controls SP based on inputting some simple reference trajectories ,or for radar, satellite and vehicle use-cases. This  thesis is committed to designing and implementing a control algorithm for the SP to control the socket. The task is divided into two main parts: simulation on Matlab/Simulink and implementation on Linux/ROS, and each part is split into several steps. Firstly, the PID control algorithm is selected and developed for the SP. Secondly, the simulation model is designed and built on Matlab/Simulink. Based on the simulation model, the control algorithm is implemented into the model. Then, the results of simulation are obtained. After that, the SP model is built on Linux/ROS. Then, the model is connected and communicated with the real platform. Finally, the output data and system performance are analysed in terms of control performance, real-time performance, anti-noise performance, etc. The results show that both the simulation and the actual platform system can follow the reference trajectory well. Although there is noise in the results of the actual platform, the noise is suppressed to a great extent by Kalman filter. / Runt 40 miljoner människor runtom i världen har amputerat delar av sina kroppar. Proteser används ofta för att stödja deras dagliga beteende. Emellertid vägrar cirka 35% av amputerade att använda proteserna på grund av komfort problem. SocketSense är ett EU-forsknings projekt som syftar till att förbättra situationen. SP används som modell för prototypen. SP skulle kunna återskapa de jämförande krafterna och vridmomenten inuti gränssnittet uttag-till-stump, givet förinspelad rörelseinformation om en amputerads gångcykel. Tidigare arbete styr dock SP baserat på att ange några enkla referensbanor, eller för radar-, satellit-och fordonsanvändningsfall. Detta examensarbete syftar till att designa och implementera en kontroll algoritmför SP för att styra socket. Uppgiften är uppdelad i två huvuddelar: simulering på Matlab/ Simulink och implementering på Linux/ROS, och varje del är uppdelad i flera steg. Först väljs och utvecklas PID-kontrollalgoritmen för SP. För det andra är simuleringsmodellen designad och byggd på Matlab/ Simulink. Baserat på simuleringsmodellen implementeras styralgoritmen i modellen. Därefter erhålls resultaten av simuleringen. Därefter är SP-modellen byggd på Linux/ROS. Sedan kopplas modellen ihop och kommuniceras med den verkliga plattformen. Slutligen analyseras utdata och systemprestanda i termer av kontrollprestanda, realtidsprestanda, anti-brusprestanda, etc. Result visar att både simuleringen och det faktiska plattformssystemet kan följa referensbanan väl. Även om det finns brus i resultaten av själva plattformen, dämpas bruset i hög grad av Kalman-filter.