CN108469728B - Decoupling control method for airborne LiDAR attitude angle compensation device - Google Patents

Decoupling control method for airborne LiDAR attitude angle compensation device Download PDF

Info

Publication number
CN108469728B
CN108469728B CN201810264066.XA CN201810264066A CN108469728B CN 108469728 B CN108469728 B CN 108469728B CN 201810264066 A CN201810264066 A CN 201810264066A CN 108469728 B CN108469728 B CN 108469728B
Authority
CN
China
Prior art keywords
control
attitude angle
compensation device
neural network
angle compensation
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201810264066.XA
Other languages
Chinese (zh)
Other versions
CN108469728A (en
Inventor
王建军
李云龙
范媛媛
苗松
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shandong University of Technology
Original Assignee
Shandong University of Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shandong University of Technology filed Critical Shandong University of Technology
Priority to CN201810264066.XA priority Critical patent/CN108469728B/en
Publication of CN108469728A publication Critical patent/CN108469728A/en
Application granted granted Critical
Publication of CN108469728B publication Critical patent/CN108469728B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/0265Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion
    • G05B13/027Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion using neural networks only
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B11/00Automatic controllers
    • G05B11/01Automatic controllers electric
    • G05B11/36Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
    • G05B11/42Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Health & Medical Sciences (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Feedback Control In General (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The invention relates to a decoupling control method for an airborne LiDAR attitude angle compensation device. In order to compensate the influence of the attitude angle change of the helicopter-mounted platform on the point cloud measured by the airborne laser radar, an attitude angle compensation device is designed, and the device is a three-axis turntable mechanism and has control coupling, so that a decoupling control method is provided. Firstly, a mathematical model of a dynamic system of the attitude angle compensation device is established, and the reversibility of the dynamic system of the attitude angle compensation device is proved. And secondly, establishing a neural network inverse system model of a dynamic system of the attitude angle compensation device, collecting neural network learning data, and performing off-line training on the neural network. The output of the neural network inverse system is then compared with the desired input value, and the difference is fed to a feedforward controller for modifying the control voltage signal of the attitude angle compensation means. And finally, a feedforward-feedback composite controller is formed by combining a fuzzy-PID controller adopting a closed-loop feedback loop, so that the real-time decoupling of the attitude angle compensation device control system is realized, the control precision and the anti-interference performance are improved, and the dynamic control performance is improved.

Description

Decoupling control method for airborne LiDAR attitude angle compensation device
Technical Field
The invention relates to a decoupling control method for realizing a control system of an airborne LiDAR attitude angle compensation device by adopting a neural network inverse system.
Background
Airborne LiDAR is a novel effective three-dimensional imaging technology and is widely applied to many fields such as topographic mapping, urban modeling and the like. In the working process of the airborne LiDAR, the attitude angle of the airborne platform can change in real time, the quality of the measured laser point cloud is influenced, and the follow-up three-dimensional imaging precision is reduced. Therefore, there is a need to design an onboard LiDAR attitude angle compensation device that can compensate in real time for the adverse effects of changes in the onboard platform three-axis attitude angle on onboard LiDAR measurements. However, the airborne LiDAR attitude angle compensation device is a complex multi-input multi-output strong coupling system, and decoupling control is required for improving control accuracy. The existing decoupling method mainly comprises a traditional decoupling method, a self-adaptive decoupling method and the like. The traditional decoupling adopts pre-compensation and is more suitable for a linear steady system; the self-adaptive decoupling is to identify a controlled object to realize the decoupling control of a parameter unknown or time-varying system, mainly solves the dynamic decoupling of a nonlinear and strong coupling system, but has complex algorithm and large calculation amount due to the requirement of an online identification system model, and is not suitable for a control system with quick response.
In order to solve the control coupling problem of the designed airborne LiDAR attitude angle compensation device, the dynamics characteristics of the attitude angle compensation device are analyzed, and a practical and effective neural network inverse system decoupling method is provided: firstly, establishing a neural network inverse system model of a dynamic system of the attitude angle compensation device; then, comparing the output of the neural network inverse system with the ideal input, and using the difference value as a control voltage signal of a feedforward controller for correcting the attitude angle compensation device; meanwhile, a neural network inverse system decoupling feedforward controller and a PID closed loop feedback controller are combined to form a feedforward-feedback composite controller, so that real-time decoupling of a multivariable coupling control system is realized, the control precision and the anti-interference performance are improved, and the dynamic control performance of the attitude angle compensation device is improved.
Disclosure of Invention
The decoupling control method of the airborne LiDAR attitude angle compensation device is characterized in that in the mechanical structure of the airborne laser radar attitude angle compensation device, a reflector (1) is supported by a cross formed by four mirror surface support rods (2) made of titanium alloy, a magnetic small hemispheroid universal bearing (3) is connected with an upright post (4), a spherical concave surface is arranged on the upright post, so that the magnetic small hemispheroid and the spherical concave surface attract each other through magnetism, and meanwhile, the magnetic small hemispheroid can flexibly rotate around an x axis and a y axis. The z axis adopts a vertical rotating shaft mode, and the lower end of the upright post (4) is arranged in a vertical rolling bearing (5). An x-axis direct-acting motor (6) and a y-axis direct-acting motor (7) are adopted to respectively drive the reflector (1) to swing up and down around the x axis and the y axis, and an x-axis grating displacement sensor (8) and a y-axis grating displacement sensor (9) are used for respectively measuring the actual movement displacement of the x-axis direct-acting motor (6) and the y-axis direct-acting motor (7). And a gear transmission mechanism (11) is driven by a z-axis rotating motor (10) to realize the rotation of the reflector (1) around the z axis, and an actual rotation angle of the z-axis rotating motor (11) is measured by a photoelectric axial angle encoder (12).
The attitude angle compensation device of the airborne laser radar is installed on an airborne platform, when three attitude angles of the airborne platform change, real-time change values of the three attitude angles are measured in real time by an airborne gyroscope, the measurement frequency of the real-time change values is 1000Hz, the real-time change values are input to an attitude angle compensation device controller (13), and then the attitude angle compensation device controller (13) respectively controls half values of a rolling angle and a pitch angle measured by reversely rotating a reflector (1) around an x axis and a y axis, so that disturbance compensation of the rolling angle and the pitch angle of the airborne platform can be respectively realized. In addition, the mirror (1) is controlled to reversely rotate around the z axis for measuring a double value of the yaw angle, so that the disturbance compensation of the yaw angle of the airborne platform can be realized. Wherein the damper (14) and the restoring spring (15) are used for adjusting the dynamic performance of the reflector (1) during rotation.
The rotation of the reflector (1) around the x axis and the y axis is around the magnetic small hemispheroid universal bearing (3) at the center, and the reflector center point (16) is superposed with the rotation center of the magnetic small hemispheroid universal bearing (3).
Wherein, through analysis, the state space equation of the control system of the attitude angle compensation device can be obtained as follows:
Figure 379616DEST_PATH_IMAGE001
(1)
Figure 707829DEST_PATH_IMAGE002
wherein, the control inputs of the three axes are respectively U = (C)U x ,U y ,U z ) The state variable is
Figure 457610DEST_PATH_IMAGE003
. The attitude angle compensation device is a 3-input 6-output complex nonlinear system, and complex coupling exists between control and motion of rotating shafts.
The decoupling method of the neural network inverse system comprises the steps that output signals of three-axis rotation are used as input signals of the neural network inverse system, then the output of the neural network inverse system is compared with ideal input corner signals of three-axis rotation, the difference value of the output signals of the neural network inverse system is used as a correction signal of three-axis rotation control voltage, and the purposes of complete decoupling and improvement of three-axis rotation control accuracy are achieved by eliminating the control difference value. In the decoupling design of a control system of an attitude angle compensation device, firstly, obtaining training data input and output by the control system according to a triaxial dynamic equation (1) of the attitude angle compensation device; secondly, constructing a neural network inverse system structure and carrying out learning training; and finally, adding a neural network inverse system decoupling algorithm into the master control system.
The control system master controller can be divided into two parts, namely (1) a PID closed loop feedback controller and (2) a neural network inverse system decoupling feedforward controller, and the two parts form a feedforward-feedback composite controller. In the attitude angle compensating device control system, the ideal input angleθ g After passing through the PID controller, the output voltage is
Figure 631103DEST_PATH_IMAGE004
=(
Figure 94314DEST_PATH_IMAGE005
) The control voltage is applied to the control mechanism of the attitude angle compensation device, the output signal is angular velocity omega, and the actual output angle is obtained through integration
Figure 593428DEST_PATH_IMAGE006
. Actual output angle
Figure 689560DEST_PATH_IMAGE006
The signal measured by the angle measuring sensor is divided into three paths to return. First path and ideal input angleθ g Subtracting to obtain a difference value, scaling the difference valueθ -1 The adjustment obtains a relative value of the output angle error. The second path is processed by a neural network inverse system to obtain an actual output angle
Figure 276531DEST_PATH_IMAGE007
The corresponding control voltage value is used for correcting the three-axis input control voltage (c) ((b))U x ,U y ,U z ) Therefore, the purpose of decoupling control is achieved, and the three-axis rotation control precision is improved. The third path is fed back to the input end and forms an angle with the ideal input endθ g Finding the difference value, and outputting a control signal (b) through a PID controllerU x , U y ,U z ) 。
Wherein the ideal input angleθ g Obtained by measurement of an airborne gyroscope, a control system master controller is programmed in an attitude angle compensation device controller (13) to realize actual output angle
Figure 938456DEST_PATH_IMAGE006
The method is obtained by measuring actual movement displacements of an x-axis linear motion motor (6) and a y-axis linear motion motor (7) respectively by an x-axis grating displacement sensor (8) and a y-axis grating displacement sensor (9) and calculating according to the corresponding relation between the actual movement displacements and the rotation angle of the reflector (1).
The constructed neural network inverse system input layer has 9 variables, namely three-axis output angular motion information:
Figure 77313DEST_PATH_IMAGE008
Figure 116201DEST_PATH_IMAGE009
Figure 772441DEST_PATH_IMAGE010
Figure 757715DEST_PATH_IMAGE011
Figure 333053DEST_PATH_IMAGE012
Figure 403777DEST_PATH_IMAGE013
Figure 112976DEST_PATH_IMAGE014
Figure 156018DEST_PATH_IMAGE015
and
Figure 636678DEST_PATH_IMAGE016
(ii) a Output layer 3 variables, i.e. three-axis drive motor control voltageU x ,U y ,U z . In addition, the neural network inverse system has 2 hidden layers in total. And determining the number of nodes of the hidden layer by adopting a combined experiment method, so that the output error of the neural network system is minimum and the calculation efficiency is optimal. The neural network inverse system adopts sigmoid function as transfer function in the input layer and hidden layer, and adopts linear function as transfer function in the output layer. According to the forward control model of the attitude angle compensation device, the input control voltages of motors of X, Y, Z three axes are respectively taken as amplitude valuesU x ,U y ,U z Periodically sampling a given voltageUAnd the angle rotated by three shafts of the three-shaft turntable
Figure 194698DEST_PATH_IMAGE017
Figure 707588DEST_PATH_IMAGE018
Figure 401875DEST_PATH_IMAGE019
And then calculated according to a numerical derivation algorithm
Figure 256698DEST_PATH_IMAGE020
Figure 833173DEST_PATH_IMAGE021
Figure 228382DEST_PATH_IMAGE022
To obtain a training data set
Figure 167388DEST_PATH_IMAGE023
And
Figure 786589DEST_PATH_IMAGE024
. To be provided with
Figure 53622DEST_PATH_IMAGE025
In order to input the quantity to the neural network,
Figure 190205DEST_PATH_IMAGE026
training for neural network output until the error of output value is less than 10 -6 And then, completing the neural network inverse system modeling of the attitude angle compensation device.
Drawings
Fig. 1 is a schematic mechanical structure diagram of an airborne laser radar attitude angle compensation device.
FIG. 2 is a decoupling control schematic diagram of an attitude angle compensation device based on a neural network inverse system.
Fig. 3 is a neural network inverse system model structure of the attitude angle compensation device.
Detailed Description
Fig. 1 is a mechanical structure of an airborne laser radar attitude angle compensation device, a reflector (1) is supported by a cross formed by four mirror surface support rods (2) made of titanium alloy, a magnetic small hemispheroid universal bearing (3) is connected with a stand column (4), a spherical concave surface is arranged on the stand column, the magnetic small hemispheroid and the spherical concave surface are attracted through magnetism, and meanwhile, the magnetic small hemispheroid can flexibly rotate around an x axis and a y axis. The z axis adopts a vertical rotating shaft mode, and the lower end of the upright post (4) is arranged in a vertical rolling bearing (5). An x-axis direct-acting motor (6) and a y-axis direct-acting motor (7) are adopted to respectively drive the reflector (1) to swing up and down around the x axis and the y axis, and an x-axis grating displacement sensor (8) and a y-axis grating displacement sensor (9) are used for respectively measuring the actual movement displacement of the x-axis direct-acting motor (6) and the y-axis direct-acting motor (7). And a z-axis rotating motor (10) is adopted to drive a gear transmission mechanism (11) to realize the rotation of the reflector (1) around the z axis, and an optoelectronic shaft angle encoder (12) is adopted to measure the actual rotation angle of the z-axis rotating motor (11). The airborne laser radar attitude angle compensation device is installed on an airborne platform, when three attitude angles of the airborne platform change, real-time change values of the three attitude angles are measured in real time by an airborne gyroscope, the measurement frequency of the real-time change values is 1000Hz, the real-time change values are input to an attitude angle compensation device controller (13), and then the attitude angle compensation device controller (13) respectively controls half values of a rolling angle and a pitch angle of a reflector (1) which are measured in a reverse rotation mode around an x axis and a y axis, so that disturbance compensation of the rolling angle and the pitch angle of the airborne platform can be respectively realized. In addition, the mirror (1) is controlled to reversely rotate around the z axis for measuring a double value of the yaw angle, so that the disturbance compensation of the yaw angle of the airborne platform can be realized. Wherein the damper (14) and the restoring spring (15) are used for adjusting the dynamic performance of the reflector (1) during rotation. The rotation of the reflector (1) around the x axis and the y axis is around the magnetic small hemispheroid universal bearing (3) at the center, and the reflector center point (16) is superposed with the rotation center of the magnetic small hemispheroid universal bearing (3).
Through analysis, the state space equation of the control system of the attitude angle compensation device can be obtained as follows:
Figure 246367DEST_PATH_IMAGE027
(2)
Figure 505310DEST_PATH_IMAGE028
wherein the three axes of control inputs are respectivelyU x ,U y ,U z The state variable is
Figure 525219DEST_PATH_IMAGE029
. The attitude angle compensation device is a 3-input 6-output complex nonlinear system, and complex coupling exists between control and motion of rotating shafts.
Fig. 2 is a decoupling control schematic diagram of an attitude angle compensation device based on a neural network inverse system. The decoupling method of the neural network inverse system is to take the output signal of the three-axis rotation as the input signal of the neural network inverse system, and then the output of the neural network inverse system and the three-axis rotationAnd comparing the ideal input rotation angle signals, and taking the difference value as a correction signal of the three-axis rotation control voltage to achieve the aims of completely decoupling and improving the three-axis rotation control precision by eliminating the control difference value. In the decoupling design of a control system of an attitude angle compensation device, firstly, obtaining training data input and output by the control system according to a three-axis dynamic equation (1) of the attitude angle compensation device; secondly, constructing a neural network inverse system structure and carrying out learning training; and finally, adding a neural network inverse system decoupling algorithm into the master control system. In fig. 2, the control system master controller can be divided into two parts, (1) a PID closed-loop feedback controller, and (2) a neural network inverse system decoupling feedforward controller, which form a feedforward-feedback composite controller. In the attitude angle compensating device control system, the ideal input angleθ g After passing through the PID controller, the output voltage is U = (U x ,U y ,U z ) The control voltage is applied to the control mechanism of the attitude angle compensation device, the output signal is angular velocity omega, and the actual output angle is obtained through integration
Figure 527810DEST_PATH_IMAGE006
. Actual output angle
Figure 254457DEST_PATH_IMAGE006
The signal measured by the angle measuring sensor is divided into three paths to return. First path and ideal input angleθ g Subtracting to obtain a difference value, scaling the difference value by a scaling factorθ -1 The adjustment obtains a relative value of the output angle error. The second path is processed by a neural network inverse system to obtain an actual output angle
Figure 74515DEST_PATH_IMAGE006
The corresponding control voltage value is multiplied by the relative value of the output angle error and the output control voltage value of the neural network inverse system, and the value is used for correcting the three-axis input control voltage (U x ,U y ,U z ) Therefore, the purpose of decoupling control is achieved, and the three-axis rotation control precision is improved. Third pathFeedback back to the input terminal at an angle to the ideal input terminalθ g Calculating the difference value, and outputting a control signal (through a PID controller)U x ,U y ,U z ). Ideal input angleθ g Obtained by measurement of an airborne gyroscope, a control system master controller is programmed in an attitude angle compensation device controller (13) to realize actual output angle
Figure 316140DEST_PATH_IMAGE006
The method is characterized in that an x-axis grating displacement sensor (8) and a y-axis grating displacement sensor (9) are used for measuring actual movement displacement of an x-axis direct-acting motor (6) and a y-axis direct-acting motor (7) respectively, and then the actual movement displacement is obtained through calculation according to the corresponding relation between the actual movement displacement and the rotating angle of the reflector (1).
Fig. 3 is a neural network inverse system model structure of the attitude angle compensation device. The constructed neural network inverse system has 9 variables in the input layer, namely three-axis output angular motion information:
Figure 122422DEST_PATH_IMAGE030
Figure 906839DEST_PATH_IMAGE031
Figure 507584DEST_PATH_IMAGE019
Figure 423456DEST_PATH_IMAGE032
Figure 299009DEST_PATH_IMAGE012
Figure 796986DEST_PATH_IMAGE033
Figure 443999DEST_PATH_IMAGE034
Figure 660217DEST_PATH_IMAGE035
and
Figure 995252DEST_PATH_IMAGE036
(ii) a Output layer 3 variables, i.e. three-axis drive motor control voltageU x ,U y ,U z ). In addition, the neural network inverse system has 2 hidden layers in total. And determining the number of nodes of the hidden layer by adopting a combined experiment method, so that the output error of the neural network system is minimum and the calculation efficiency is optimal. The input layer and the hidden layer of the neural network inverse system both adopt sigmoid functions as transfer functions, and the output layer adopts linear functions as transfer functions. According to the forward control model of the attitude angle compensation device, the input control voltages to the motors of X, Y, Z three axes are respectively taken as the amplitudes (U x ,U y ,U z ) Periodically sampling a given voltageUAnd the angle rotated by three shafts of the three-shaft turntable
Figure 878895DEST_PATH_IMAGE037
Figure 555863DEST_PATH_IMAGE038
Figure 134744DEST_PATH_IMAGE039
And then calculated according to a numerical derivation algorithm
Figure 352098DEST_PATH_IMAGE040
Figure 559089DEST_PATH_IMAGE041
Figure 127998DEST_PATH_IMAGE042
To obtain a training data set
Figure 459753DEST_PATH_IMAGE043
And
Figure 684061DEST_PATH_IMAGE044
. To be provided with
Figure 276716DEST_PATH_IMAGE045
In order to input the quantity to the neural network,
Figure 561067DEST_PATH_IMAGE046
training for neural network output until the error of output value is less than 10 -6 And then, completing the modeling of the neural network inverse system of the attitude angle compensation device.
The above description is only an embodiment of the present invention, but the scope of the present invention is not limited thereto, and any changes or substitutions that can be easily conceived by those skilled in the art within the technical scope of the present invention are included in the scope of the present invention. Therefore, the protection scope of the present invention should be subject to the protection scope of the claims.

Claims (3)

1. A decoupling control method for an airborne LiDAR attitude angle compensation device is characterized in that a master controller of an attitude angle compensation device control system is divided into two parts, namely a PID closed-loop feedback controller and a neural network inverse system decoupling feedforward controller, wherein the two parts form a feedforward-feedback composite controller; in the attitude angle compensating device control system, the ideal input angleθ g After passing through the PID controller, the output voltage is U = (U x ,U y ,U z ) The control voltage is applied to the control mechanism of the attitude angle compensation device, the output signal is angular velocity omega, and the actual output angle is obtained through integrationθ(ii) a Actual output angleθThe signal measured by the angle measuring sensor is divided into three paths to return; first path and ideal input angleθ g Subtracting to obtain a difference value, scaling the difference valueθ -1 Adjusting to obtain a relative value of the output angle error; the second path is processed by a neural network inverse system to obtain an actual output angleθThe corresponding control voltage value is multiplied by the relative value of the output angle error and the output control voltage value of the neural network inverse system, and the value is used for correcting the three-axis input control voltage (U x ,U y ,U z ) Therefore, the purpose of decoupling control is achieved, and the three-axis rotation control precision is improved; the third path is fed back to the input end and forms an angle with the ideal input endθ g Calculating the difference value, and outputting a control signal (through a PID controller)U x ,U y ,U z ) (ii) a The closed-loop feedback control adopts PID double closed-loop control, and an angular speed feedback inner loop and an angular position feedback outer loop; the feedback signal of the control system comes from the collected signal of the sensor, and not only the angular displacement but also the angular velocity is needed.
2. The on-board LiDAR attitude angle compensation device decoupling control method of claim 1, the state space equation of the attitude angle compensation device control system being:
Figure 679760DEST_PATH_IMAGE002
in the state space equation, the three axes of control inputs are respectivelyU x U y U z The state variable is
Figure 716987DEST_PATH_IMAGE004
In which
Figure 995521DEST_PATH_IMAGE006
The angles of the three axes of the three-axis turntable which are correspondingly rotated are obtained; the attitude angle compensation device is a 3-input 6-output complex nonlinear system, and complex coupling exists between control and motion of rotating shafts.
3. The decoupling control method for the airborne LiDAR attitude angle compensation device according to claim 1 or 2, wherein the constructed neural network inverse system has 9 variables in total at the input layer, namely three-axis output angular motion information:
Figure 471502DEST_PATH_IMAGE008
(ii) a Output layer 3 variables, i.e. three-axis drive motor control voltageU x 、U y 、U z (ii) a The neural network reverse system has 2 hidden layers; determining the number of nodes of the hidden layer by adopting a combined experiment method, so that the output error of the neural network system is minimum and the calculation efficiency is optimal; the neural network inverse system adopts sigmoid function as transfer function in the input layer and hidden layer, and adopts linear function as transfer function in the output layer; according to the forward control model of the attitude angle compensation device, the input control voltages of the motors of X, Y, Z three axes are respectively taken as the amplitude valuesU x U y U z Periodically sampling a given voltageUAnd the angle rotated by three shafts of the three-shaft turntable
Figure 588100DEST_PATH_IMAGE010
And then calculated according to a numerical derivation algorithm
Figure 858544DEST_PATH_IMAGE010
To obtain a training data set
Figure 562058DEST_PATH_IMAGE012
And
Figure 513834DEST_PATH_IMAGE014
(ii) a To be provided with
Figure 314300DEST_PATH_IMAGE016
The input quantity of the neural network is the input quantity of the neural network,
Figure 693328DEST_PATH_IMAGE018
training for neural network output until the error of output value is less than 10 -6 And then, completing the neural network inverse system modeling of the attitude angle compensation device.
CN201810264066.XA 2018-03-28 2018-03-28 Decoupling control method for airborne LiDAR attitude angle compensation device Active CN108469728B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810264066.XA CN108469728B (en) 2018-03-28 2018-03-28 Decoupling control method for airborne LiDAR attitude angle compensation device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810264066.XA CN108469728B (en) 2018-03-28 2018-03-28 Decoupling control method for airborne LiDAR attitude angle compensation device

Publications (2)

Publication Number Publication Date
CN108469728A CN108469728A (en) 2018-08-31
CN108469728B true CN108469728B (en) 2022-09-30

Family

ID=63264877

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810264066.XA Active CN108469728B (en) 2018-03-28 2018-03-28 Decoupling control method for airborne LiDAR attitude angle compensation device

Country Status (1)

Country Link
CN (1) CN108469728B (en)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109270552B (en) * 2018-11-07 2022-12-30 山东理工大学 Helicopter-mounted laser radar laser scanning attitude angle stabilizing method and device
CN110262227A (en) * 2019-04-19 2019-09-20 南京航空航天大学 A kind of inertance element method for independently controlling for Helicopter Main anti-reflection resonance vibration isolation
CN111273544B (en) * 2020-04-01 2022-11-15 河海大学常州校区 Radar pitching motion control method based on prediction RBF feedforward compensation type fuzzy PID
CN116165641A (en) * 2020-04-30 2023-05-26 上海禾赛科技有限公司 Laser radar and control method thereof
CN114167718A (en) * 2021-11-11 2022-03-11 中国航空工业集团公司北京长城计量测试技术研究所 Control method and device of three-axis turntable, computer equipment and storage medium

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5566065A (en) * 1994-11-01 1996-10-15 The Foxboro Company Method and apparatus for controlling multivariable nonlinear processes
CN101727071A (en) * 2009-11-13 2010-06-09 上海电力学院 Concurrent control method of neural network model and quadratic mononeuron PID
CN102621890A (en) * 2012-03-30 2012-08-01 中国科学院光电技术研究所 Control method for photoelectric tracking and stabilization platform of moving carrier
CN105676209B (en) * 2016-04-01 2023-02-24 山东理工大学 Helicopter-mounted laser radar platform three-dimensional attitude angle complex vibration real-time compensation method and device
US9663252B1 (en) * 2016-12-07 2017-05-30 Beihang University Method for attitude controlling based on finite time friction estimation for flexible spacecraft
CN106896722B (en) * 2017-03-29 2019-11-29 郑州轻工业学院 The hypersonic vehicle composite control method of adoption status feedback and neural network
JP6585673B2 (en) * 2017-09-05 2019-10-02 エスゼット ディージェイアイ テクノロジー カンパニー リミテッドSz Dji Technology Co.,Ltd Aircraft attitude control method

Also Published As

Publication number Publication date
CN108469728A (en) 2018-08-31

Similar Documents

Publication Publication Date Title
CN108469728B (en) Decoupling control method for airborne LiDAR attitude angle compensation device
CN111099045B (en) Full physical simulation method for double super satellite dynamics and control air floatation platform
CN108646572B (en) Control method of three-axis pan-tilt servo motor based on combination of BP neural network and active disturbance rejection controller
Shao et al. Robust back-stepping output feedback trajectory tracking for quadrotors via extended state observer and sigmoid tracking differentiator
CN105676209A (en) Helicopter-borne laser radar platform three-dimensional attitude angle complex vibration real-time compensation method and device
CN108820255B (en) Three-super control full-physical verification system and method for moving target tracking
CN108445766A (en) Model-free quadrotor drone contrail tracker and method based on RPD-SMC and RISE
CN104765272A (en) Four-rotor aircraft control method based on PID neural network (PIDNN) control
CN109460052A (en) A kind of control method for spelling group aircraft
CN106777656A (en) A kind of industrial robot absolute precision calibration method based on PMPSD
CN109828467B (en) Data-driven unmanned ship reinforcement learning controller structure and design method
CN110361829A (en) A kind of telescope Pointing Calibration method and telescope
CN111273544B (en) Radar pitching motion control method based on prediction RBF feedforward compensation type fuzzy PID
CN111880410A (en) Four-rotor unmanned aerial vehicle fault-tolerant control method for motor faults
CN107187615A (en) The formation method of satellite distributed load
Su et al. Adaptive nonlinear control algorithm for a self-balancing robot
CN110703603A (en) Control method of multi-layer recursive convergence neural network controller of unmanned aerial vehicle
CN114310911B (en) Driving joint dynamic error prediction and compensation system and method based on neural network
Xu et al. A fuzzy PID controller-based two-axis compensation device for airborne laser scanning
CN110377044B (en) Finite time height and attitude tracking control method of unmanned helicopter
CN106292297B (en) Attitude control method based on PID controller and L1 adaptive controller
Ibarra‐Jimenez et al. Nonlinear control with integral sliding properties for circular aerial robot trajectory tracking: Real‐time validation
Lin et al. Robust observer-based visual servo control for quadrotors tracking unknown moving targets
CN108445753B (en) Method for balancing lateral force and restraining lateral reverse thrust of unmanned aerial vehicle
Yu et al. Disturbance observer-based autonomous landing control of unmanned helicopters on moving shipboard

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant