phikhopov09

6
Control System Design for Robotic Airship Pshikhopov V.Kh., Medvedev M. Y., Sirotenko M.Y., Kostjukov V.A. Taganrog Technological Institute of South Federal University, Taganrog, Russia ( Tel: (+7)8634 37-16-94; e-mail: [email protected]). Abstract: In this paper control system design for robotic airship is developed. The nonlinear multilinked mathematic model of airship is considered. The results of aerodynamic analysis, parametric and structure disturbances estimation, nonlinear control algorithms, and neural network motion planning are presented. Theoretic results are implemented on experimental robotic mini-airship. Keywords: Nonlinear Control System Design, Estimation, Adaptation, Neural Network Planning. 1. INTRODUCTION Design of robotic airship-based platform (RABP) is of significant interest nowadays. This interest is attracted by unique capabilities of airships and robotic systems on basis of airships (Pshikhopov, 2004, Elfes et al., 1998, Sang-Jong Lee et al., 2004, Lacroix, 2000): capability to hover without additional power costs; large-scale flight range and carrying capacity; safety in case of control system failure; vertical take-off and landing, etc. All these capabilities make airships an attractive solutions for the civilian and military objectives, connected with environment monitoring, supervision and diagnostics of high- rise facilities, patrolling, providing communication, air reconnaissance, map-making, radar supervision, etc. Implementation of such systems as autonomous mobile robots increases its functional capabilities, minimizes human participation to objective description. Obviously, such target is connected with a number of problems, resulted from high dimensional and multilinked airship mathematical model, parameters non-stationarity, external disturbances, and a priori non-formalized environment (Pshikhopov, 2006, Medvedev, 2006). The procedure of constructing control systems (CS) of RABP is presented in this work. This procedure considers development of a valid mathematical model, effective control algorithms, motion planner, and also correct hardware selection. 2. MATHEMATICAL MODEL OF AN AIRSHIP To design control system on base of paper (Pshikhopov, Medvedev, 2006) it is possible to consider model of dynamics and kinematics of an airship as a differential equation system: ) ( 1 v d u F F F M x - - = - & , (1) KU d= & , (2) ÷ ÷ ø ö ç ç è æ Q S Q S = Q S = Q ) , ( ) , ( ) , ( x x x Y P & , (3) x – m-vector of projections of terrestrial and angular velocities vectors of airship in a body coordinate system OXYZ, m 6 £ ; M(l) - (m×m)- matrix of mass-inertial parameters, where l – vector of no stationary parameters, elements of this vector are airship mass, moments of inertia, apparent masses; u F (x,P, ,l) d - m-vector of control forces and control moments; d F (x,P,l) - m-vector of nonlinear dynamic component; v F - m-vector of measurable and no measurable external disturbances, d - m-vector of controllable components (air mass inside an envelope, deflection angle of aerodynamic control surfaces and operating levers of motor thrust, etc.); K – (m×m)-matrix of control coefficients; U – n-vector of control actions; T P Y ) , (Q = - n-vector of position P and orientation Q of body coordinate system relative to base coordinate system; ) , ( x Q S - n-vector of kinematical constraints; ) , ( x P Q S - vector of linear velocities of body coordinate system relative to base system; ) , ( x Q S Q - vector of angular velocities of body coordinate system relative to base system. Further we consider m n = lossless in generality. Airship dynamic models (1), (2), (3) are multilinked systems of nonlinear differential equations. Its components are defined by design and parameters of specific airship, as well as by structure and type of external disturbances. Besides, distinctive feature of an airship is non-stationarity of vector l components, dependent on functioning conditions of airship and its design characteristics. Necessity for considering full airship dynamics is defined by strict requirements for airship functioning quality. It is necessary to

Upload: victor

Post on 09-Sep-2015

215 views

Category:

Documents


0 download

DESCRIPTION

Convolutional Neural Network

TRANSCRIPT

  • Control System Design for Robotic Airship

    Pshikhopov V.Kh., Medvedev M. Y., Sirotenko M.Y., Kostjukov V.A.

    Taganrog Technological Institute of South Federal University, Taganrog,Russia ( Tel: (+7)8634 37-16-94; e-mail: [email protected]).

    Abstract: In this paper control system design for robotic airship is developed. The nonlinear multilinkedmathematic model of airship is considered. The results of aerodynamic analysis, parametric and structuredisturbances estimation, nonlinear control algorithms, and neural network motion planning are presented.Theoretic results are implemented on experimental robotic mini-airship.Keywords: Nonlinear Control System Design, Estimation, Adaptation, Neural Network Planning.

    1. INTRODUCTION

    Design of robotic airship-based platform (RABP) is ofsignificant interest nowadays. This interest is attracted byunique capabilities of airships and robotic systems on basis ofairships (Pshikhopov, 2004, Elfes et al., 1998, Sang-Jong Leeet al., 2004, Lacroix, 2000): capability to hover withoutadditional power costs; large-scale flight range and carryingcapacity; safety in case of control system failure; verticaltake-off and landing, etc.

    All these capabilities make airships an attractive solutions forthe civilian and military objectives, connected withenvironment monitoring, supervision and diagnostics of high-rise facilities, patrolling, providing communication, airreconnaissance, map-making, radar supervision, etc.

    Implementation of such systems as autonomous mobilerobots increases its functional capabilities, minimizes humanparticipation to objective description. Obviously, such targetis connected with a number of problems, resulted from highdimensional and multilinked airship mathematical model,parameters non-stationarity, external disturbances, and apriori non-formalized environment (Pshikhopov, 2006,Medvedev, 2006).

    The procedure of constructing control systems (CS) of RABPis presented in this work. This procedure considersdevelopment of a valid mathematical model, effective controlalgorithms, motion planner, and also correct hardwareselection.

    2. MATHEMATICAL MODEL OF AN AIRSHIP

    To design control system on base of paper (Pshikhopov,Medvedev, 2006) it is possible to consider model ofdynamics and kinematics of an airship as a differentialequation system:

    )(1 vdu FFFMx --= -& , (1)KUd =& , (2)

    QSQS=QS=

    Q ),(),(

    ),(xx

    xY P& , (3)

    x m-vector of projections of terrestrial and angularvelocities vectors of airship in a body coordinate systemOXYZ, m 6 ; M(l) - (mm)- matrix of mass-inertialparameters, where l vector of no stationary parameters,elements of this vector are airship mass, moments of inertia,apparent masses; uF (x, P, , l)d - m-vector of control forcesand control moments; dF (x,P, l) - m-vector of nonlineardynamic component; vF - m-vector of measurable and nomeasurable external disturbances, d - m-vector ofcontrollable components (air mass inside an envelope,deflection angle of aerodynamic control surfaces andoperating levers of motor thrust, etc.); K (mm)-matrix ofcontrol coefficients; U n-vector of control actions;

    TPY ),(Q= - n-vector of position P and orientation Q ofbody coordinate system relative to base coordinate system;

    ),( xQS - n-vector of kinematical constraints; ),( xP QS -vector of linear velocities of body coordinate system relativeto base system; ),( xQSQ - vector of angular velocities ofbody coordinate system relative to base system. Further weconsider m n= lossless in generality.

    Airship dynamic models (1), (2), (3) are multilinked systemsof nonlinear differential equations. Its components aredefined by design and parameters of specific airship, as wellas by structure and type of external disturbances. Besides,distinctive feature of an airship is non-stationarity of vectorl components, dependent on functioning conditions ofairship and its design characteristics. Necessity forconsidering full airship dynamics is defined by strictrequirements for airship functioning quality. It is necessary to

  • perform airship aerodynamic properties analysis for the mostcorrect definition of vector vF .

    3. ANALISYS OF AERODYNAMIC FORCES ANDTORQUES

    Dependences of basic aerodynamic coefficients on angles ofattack and slide had been got using NUMECA software suitfor hydro- and aerodynamic calculations.

    Figure 1 shows diagrams of dependences of head resistancecoefficient and lift force coefficient on attack angle intospeed coordinate system with three different airshipvelocities: v = 30, 50, and 80 m/s. These dependences arewell conformed to both theoretical and experimental data ofsuch type of airship (Kirilin, Ivchenko, 2000).

    Fig. 1a. Head resistance coefficient depending on attackangle in speed coordinate system plot.

    Fig. 1b. Lift force coefficient depending on attack angle inspeed coordinate system plot.

    Pressure and temperature distribution over surface, velocitiesfield distribution of incident stream in vicinity of airshipunder different attack angles and velocities also have beenacquired. Figure 2 shows velocities vectors distribution by itsvalues and directions in plane, which is lies on airshipsymmetry axis.

    Fig. 2. Incident flow velocities distribution on aerostatvicinity.

    Use of NUMECA software suit for obtaining requiredaerodynamic characteristics significantly decreased financialexpenditure, which could be necessarily for experimentalblowing of researched object.

    4. DISTURBANCIES ESTIMATION

    Controller equations are complemented by dynamic adaptiveestimator, based on results presented in paper (Pshikhopov,Medvedev, 2006):

    ( ) ( )( ) ( )

    1 01 1 1 2 2

    2 02 1 1

    1 1

    ,

    ,

    ,

    ii i i i j i i j

    ii i i i j

    i i i j

    dz tl F z l mV z l mV

    dtdz t

    l F z l mVdt

    F z l mV

    = - + + + +

    = - + +

    = +(4)

    ( ) ( )( ) ( )

    1 0 0 01 1 1 2 2

    2 0 02 1 1

    01 1

    ,

    ,

    .

    jj j j j j j j j j j

    jj j j j j j

    j j j j j

    dz tl M z l J z l J

    dtdz t

    l M z l Jdt

    M z l J

    = - + + w + + w

    = - + + w

    = + w (5)

    Equations (4) are estimation of disturbances on linearvelocity circuit; (5) implement disturbances estimation byrotation velocity; , , ,i j x y z= , 1 2 1 , 2, ,i i j jz z z z estimatorstate variables; 0iF ,

    0jM known or measurable forces and

    torques, applied to moving object; ,j jV w - object linear and

  • angle velocities; 0, jm J - mass and nominal moments ofinertia; 1 2 1 , 2, ,i i j jl l l l - estimators coefficients, providing itoperating speed; ,i jF M

    )- evaluations of indeterminate forces

    and moments.

    5. MOTION PLANNING AND CONTROL ALGORITHMSSYNTHESIS APPROACHES

    Taking into consideration peculiarities of RABP, followingtasks are very actual for its operation: airship stabilization atthe certain point in a base coordinates space with desirablevalues of yaw, pitch and roll angles (for kinematic schemewith convertible thrust vector); path following in basecoordinate system, with constant airspeed V and givenorientation of body coordinate system; motion to the point inbase coordinate system, prescribed path following, withoutadditional requirements to airship airspeed. All these taskscould be represented in a form of vector function Y of basecoordinates, orientation angles and its derivations, defined asfollowing:

    0),,(

    )()()(),,(

    ),( 321 =Q

    ++=Q=Y tPtAPtAPtAP

    tPtPN

    j

    iiiT

    tr ,

    vi ,1= , m,1=j (6)

    )),()()(()( 321 tAPtAPtAPNT

    nnnxn ++=,dim mtr =+=Y mn

    where ( )tAij matrices of coefficient correspondingdimension defined by planner; n dimension of operatingspace of RABP; m dimension of vector F definesrequirements to orientation of RABP; 0=x for pointstabilization; 1=x for path following.Jacobi matrix for vector tr is

    ( ) ( )

    ( )nmJP

    tAtAP

    JJJJ

    P

    NPN

    YJ

    s

    Tj

    Tj

    iiT

    P

    NNP

    TT

    TT

    Ttr

    s

    =QF

    F

    +==

    QF

    F

    Q

    =Y=

    FQF

    Q

    dim

    ,02 21

    mVJYJ crtsck =+=Y=++=Y mndim,0~& ,

    ( )( )TVVV mn x 0,,0~ 2*21 -= - ,( ) ( )( )

    ( ) ,,, 321t

    tPAPtAtAP

    J tjiii

    T

    t

    QF

    ++=

    &&&

    where ijA& matrix of time derivatives of matrix ( )tAij , tjF elements of vector F depending from time explicitly;

    mn 0,0 1- zero vectors; V , *V real airship motion and itsdesired value.

    All requirements to steady-state movement operation of RABPcan be presented in the next form

    0~ =Y+Y=Y cktr A , vi ,1= , m,1=j , ,00~

    F=

    AA

    A

    where A~ block diagonal matrix of constant coefficients;mmA =~dim , FA mm matrix determines transients

    of orientation angles of the RABP; A nn matrix definestransients of linear coordinates.

    Algorithmic solutions for these tasks for RABP controlsystem are based on work (Pshikhopov, 2009). In result weobtain following control algorithms for airship, defined bymath model (1), (3):

    ( ) ( ) nFFVAtKPKKATMF dtru ~~)(~~ 2110 ++Y+++-= - & ,( ) ),(dim, 010 mmKJJJJK xPx =+= SQQS

    ),(dim,~~ 112111 nmKKKATK =+=

    ( ) ),(dim,0 11111 nmKJJJJK TPm =+= SQQQQSn),(dim,

    ~~)~~( 1212 nmKATJATK ss =++=

    ),1(dim,~~)

    ~~( 2*

    2 =++= mKJATJATK tt

    ),(1 VP JJJ += ,)020( )1( TnTnV PJ -= mn x &

    { } { },,,,here, Q=Q=S=S xjPij

    J iij

    ,,Q

    QQ ==

    N

    P

    NPP J

    JJ

    JJ

    J

    ),1(dimdim

    ,,,),3,1(),2,1(),1,1(

    *

    23

    2

    22

    2

    21

    2****

    ==

    F

    F

    F=

    mJJ

    tttjjjJ

    tt

    T

    tttt

    ( )32121* )2(2)(),1( kkkTkkTt APAAPPAAPkj &&&&&&&&& ++++= ,

    TS

    S YJ

    =G

    where T% , A% , - functional coefficients, their structure is:

    , ,

    where gT is constant, defining pattern of change of trajectoryvelocity kV in transient condition; TF is matrix of constantsof suitable dimension, defining on basis of orientation angleof RABP nature of transient conditions; T is diagonal( ) ( )1 1v v- - matrix, defining robot motion type relevantlyto trajectory manifold trY .

  • Works (Pshikhopov, 2004) and (Pshikhopov, Medvedev,2006) explains the necessity of taking into accountmultilinked math models. Synthesis procedure for internalcoordinates and external disturbances estimator, andmodeling results, confirming correctness of a theoreticalstatements are also presented.

    RABP application areas define its functioning intoindeterminate and non-stationary environments, which raisesrequirements for a motion planning system. Specifically,intelligent motion planning system is essential for providingairship low level control system with feasible motiontrajectories by analyzing computer vision data.

    A neural network planner is proposed (Pshikhopov,Sirotenko, 2004) to form a motion trajectory to be performedby a controller. A planner consists of two parts: global pathplanning module and local planner. Global path planning

    module calculates robot trajectory according to the currentflight task and map using well-known A* algorithm. Localplanner uses pretrained convolutional neural network(LeCun, Bengio 1995) to extract information aboutenvironment from visual data and make a corrections tocurrent trajectory on a base of visual data. Corrections maybe different depending on task: object following, obstacleavoidance, lengthy objects tracking. Structure of this planneris shown on fig. 3. A main distinctive feature of the proposedplanner from similar (Hadsell et al, 2009) is the way motiontrajectories are planned. The output of planner is coefficientsof quadric and linear form equation, defining the trajectory inbase coordinate space.

    Such representation of robot motion trajectories together withproposed planning and control algorithms refining the qualityof performing path-following tasks.

    6. STRUCTURE OF ROBOTIC AIRSHIP ONBOARDCONTROL SYSTEM

    Obtained theoretical and simulation results enables to suggestthe structure of RABP control system, shown on the figure 4.

    Airship on-board flight control system (OFCS) can beseparated into few functional blocks: onboard control system,onboard equipment control system, actuators, embeddedmodules of on-board equipment, and power-supply system.

    Board carrier control system includes actuators state sensors,GLONASS/GPS navigation system, inertial navigationsystem, and computer. Actuators state sensors are various

    Fig 3. Neural network planning system

    Fig 4. Airship onboard flight control system

  • type encoders. It provides actuators position data to controlsystem. Satellite navigation system GLONASS/GPS isnecessary for obtaining airship global coordinates. Inertialnavigation unit consists of inertial measurement devices suchas gyroscopes, accelerometers etc, which are essential fororientation and coordinates calculation.

    Computer forms motion trajectory, and calculate controlsignals according to synthesized control law, currentobjective and data from listed systems. Next these signals areinput to actuators, which are drives of propellers, tractionvector angle changer or aerodynamic rudders.

    Embedded modules of on-board equipment could betransceiver equipment, camera based computer vision system,laser scanners, radar systems, complementary modules.Transceiver equipment is essential for receiving flight task,transmit video, remote control, and other data exchange tasks.Camera based computer vision system, laser scanners, andradar systems could be used for both fight tasks andenvironment data receiving to provide a valid trajectoryplanning. Presence or absence any of modules is determinedby given task, defined for RABP.

    Power-supply system controls distribution of electric powerinto a system, and implement energy-efficient algorithms.

    7. HARDWARE IMPLEMENTATION OF CONTROLSYSTEM

    Results of research are implemented in prototype of airship-based autonomous mobile robot Sterkh, shown on figure 5.These results also can be used to design perspective RABP.

    Fig. 5. Autonomous mobile robot Sterkh based on mini-airship

    8. CONCLUSION

    This paper presented algorithms and structure of airshipbased robotic complex control system. Control system is

    build on nonlinear and multilinked motion model withconsideration of dynamic, kinematic and actuators equations.Comparing with traditional (separated by linear and lateralmotion) approaches, this method allows to expand systemsfunctional capabilities by taking into account non-linearoperation modes and multilinked math model of controlobject.

    Identification of aerodynamic properties of airship performedby airflow simulation software, which is significantlyspeeding up and reduces price of parametric support for mathmodel.

    Unmeasured disturbances are evaluated by non-linearestimators, distinguished by generality, which enables toobtain estimations of disturbances, caused by parametricuncertainties, external influence and object structure changes,such as elastic strains.

    Automatic control system makes possible to plan airshipmotion trajectory in global coordinate system, which allowsperforming motions along all trajectories that could bedescribed by quadric and linear forms.

    Achieved theoretical results have been implemented inseveral projects. Onboard flight control system structure,shown on fig. 3, allows to perform fully autonomous flight,semiautomatic flight by a given target points and parametersand airship remote control mode.

    9. ACKNOWLEDGMENTS

    The work was supported by Russian Fund of Basic Research.Grant N 07-08-00373-a.

    REFERENCES

    Elfes A., Siqueira Bueno S., Bergerman M., Ramos J.G.A semi-autonomous robotic airship for environmentalmonitoring missions. Robotics and Automation, 1998.Proceedings. 1998 IEEE International Conference on.Volume 4, 16-20 May 1998 Page(s):3449 - 3455 vol.4.

    Hadsell R., Sermanet P., Scoffier M., Erkan A., KavackuogluK., Muller U., LeCun Y. Learning Long-Range Visionfor Autonomous Off-Road Driving, Journal of FieldRobotics, 26(2):120-144, February, 2009.

    Kirilin A.N., Ivchenko, B.A. Calculating of nonrigid airshipsbasic parameters. Russian aeronautical society, Moscow,2000.

    Lacroix S. Towards autonomous airships: research anddevelopments at LAAS/CNRS. In 3rd InternationalAirship Convention and Exhibition, Friedrichshafen(Germany), July 2000

    LeCun Y. and Bengio Y. Convolutional Networks forImages, Speech, and Time-Series. Arbib, M. A. (Eds),

  • The Handbook of Brain Theory and Neural Networks,MIT Press, 1995.

    Pshikhopov V.Kh. Position and trajectory control of mobileobjects. Taganrog, TIT SFU press, 2009.

    Pshikhopov V. Kh. Airships: prospects of using in robotics.Mechatronics, automatization, control, #5, p. 15-20.2004

    Pshikhopov V.Kh., Medvedev M.J. Structure synthesis ofmobile object autopilot with disturbances estimation.Information-measuring and control systems, #1, p. 103-109. 2006

    Pshikhopov V.Kh., Medvedev M.J., Bekishev A.V. Structuresynthesis of dynamic controllers for position-trajectorycontrol systems of adaptive mobile robots on basis ofairships. Jurevich E.I. (ed.), Collected papers of 12-thscientific and technical conference Extreme robotics,p. 45-54. St. Petersburg, 2002.

    Pshikhopov V.Kh., Sirotenko M.J. Autonomous mobile robotcontrol systems with neural network motion plannersdesign. Proc. of the VIII Int. Conf. on Systems,Automatic Control and Measurements. Belgrad. Serbiaand Montenegro, p. 238-241. 2004.

    Sang-Jong Lee, Seong-Pil Kim, Tae-Sik Kim, Hyoun-Kyoung Kim, Hae-Chang Lee. Development ofautonomous flight control system for 50m unmannedairship. Proceedings of the Intelligent Sensors, SensorNetworks and Information Processing Conference, 2004.