CN113433820B - Control system of six-rotor spherical robot and trajectory control method thereof - Google Patents

Control system of six-rotor spherical robot and trajectory control method thereof Download PDF

Info

Publication number
CN113433820B
CN113433820B CN202110800514.5A CN202110800514A CN113433820B CN 113433820 B CN113433820 B CN 113433820B CN 202110800514 A CN202110800514 A CN 202110800514A CN 113433820 B CN113433820 B CN 113433820B
Authority
CN
China
Prior art keywords
control
spherical robot
angular velocity
expected
rotor
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
CN202110800514.5A
Other languages
Chinese (zh)
Other versions
CN113433820A (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.)
Beihang University
Yunnan Innovation Institute of Beihang University
Original Assignee
Beihang University
Yunnan Innovation Institute of Beihang University
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 Beihang University, Yunnan Innovation Institute of Beihang University filed Critical Beihang University
Priority to CN202110800514.5A priority Critical patent/CN113433820B/en
Publication of CN113433820A publication Critical patent/CN113433820A/en
Application granted granted Critical
Publication of CN113433820B publication Critical patent/CN113433820B/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
    • 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.

Abstract

The invention discloses a control system of a six-rotor spherical robot, which is characterized by comprising a position controller, an attitude controller, a control distributor and a spherical rolling dynamics module, wherein the position controller is connected with the control distributor through a control signal line; the position controller inputs the track waypoint and the current position information received by the sensor, calculates deviation, outputs expected rolling angular velocity and transmits the expected rolling angular velocity to the attitude controller; the attitude controller inputs the expected rolling angular speed and the angular speed data measured by the sensor, calculates the angular speed deviation, outputs the expected driving moment and transmits the expected driving moment to the control distributor; the control distributor resolves the expected driving torque into a control signal of the motor according to the spatial configuration of the motor arrangement in the six-rotor spherical robot and the current attitude information. The invention adopts the cascade PID algorithm to carry out the track control, solves the control problem of the six-rotor spherical robot, and realizes the complex track tracking and the accurate and stable control of the spherical robot.

Description

Control system of six-rotor spherical robot and trajectory control method thereof
Technical Field
The invention relates to the technical field of spherical robot control, in particular to a control system of a six-rotor spherical robot and a speed and position control method thereof.
Background
The existing spherical robot control technology is mostly based on a gravity pendulum type and driving wheel type driving mode, and adopts a control strategy of linear rolling and yaw steering decoupling, so that the problem of complex track tracking exists, and the accurate and stable control effect is difficult to realize.
Disclosure of Invention
The invention aims to: aiming at the existing problems, the control system of the six-rotor spherical robot and the track control method thereof are provided, so that the six-rotor spherical robot can be accurately and stably controlled.
The technical scheme adopted by the invention is as follows:
the invention relates to a control system of a six-rotor spherical robot, which comprises a position controller, an attitude controller and a control distributor, wherein the position controller is connected with the attitude controller;
the position controller inputs the track waypoint and the current position information received by the sensor, calculates deviation, outputs expected rolling angular velocity and transmits the expected rolling angular velocity to the attitude controller;
the attitude controller inputs the expected rolling angular speed and the angular speed data measured by the sensor, calculates the angular speed deviation, outputs the expected driving moment and transmits the expected driving moment to the control distributor;
the control distributor resolves the expected driving torque into a control signal of the motor according to the spatial configuration of the motor arrangement in the six-rotor spherical robot and the current attitude information.
Preferably, the system further comprises a spherical rolling dynamics module, and the spherical rolling dynamics module outputs the position information, the angular velocity data and the attitude information measured by the corresponding sensors to the position controller, the attitude controller and the control distributor respectively.
The invention also discloses a track control method of the six-rotor spherical robot, which is based on the control system of the six-rotor spherical robot and adopts a cascade PID algorithm to carry out track control.
Preferably, the cascade PID algorithm specifically includes the following steps:
the method comprises the following steps: acquiring track waypoints and position information obtained by a position sensor as primary PID input, and performing integral separation by using a PID algorithm to obtain an expected rolling angular velocity;
step two: taking the expected rolling angular speed and the measured angular speed data as the input of a second-stage PID, calculating the angular speed deviation, and outputting expected driving torque;
step three: according to the spatial configuration of the arrangement of the motors in the six-rotor spherical robot and the detected current attitude information, the expected driving torque is resolved into control signals of the six motors.
Preferably, the position information obtained by the position sensor in the first step is sequentially subjected to mean filtering processing and kalman filtering processing.
Preferably, in the first step, integration and separation are performed by using a PID algorithm, so as to obtain the desired roll angular velocity: and replacing the original differential by the product of the proportional coefficient and the derivative value of the input value, performing integral separation on the deviation differential, and outputting the expected rolling angular speed based on the calculation result.
Preferably, the desired roll angular velocity is calculated by the formula:
Figure BDA0003164533190000021
wherein, KpIs a proportionality coefficient, KIIs the integral coefficient, KDIs the differential coefficient, e is the deviation of the desired position from the actual position,
Figure BDA0003164533190000022
is the desired roll angular velocity.
Preferably, the second step specifically comprises: construction of angular velocity control signals described under inertial frame by PI controller
Figure BDA0003164533190000023
Figure BDA0003164533190000024
Wherein the content of the first and second substances,
Figure BDA0003164533190000025
for desired roll angular velocity, ωeA description of the angular velocity data measured for the sensor in an inertial coordinate system; the ω iseThe calculation formula of (2) is as follows:
ωe=Rb2eωB
Figure BDA0003164533190000026
wherein, ω isBThe angular velocity data measured for the sensor are described in the body coordinate system as a reference system, c stands for cos, s stands for sin,
Figure BDA0003164533190000027
theta, psi are 3 Euler angles;
angular acceleration control signal described under inertial coordinate system
Figure BDA0003164533190000028
Resolving into a drive torque control signal described in a body coordinate system
Figure BDA0003164533190000029
Figure BDA00031645331900000210
Where I is the inertia matrix.
Preferably, the third step specifically comprises: let the speed of rotation of rotor i (i ═ 1,2, …,6) reach ωiThe action effect is decomposed into a lifting force F in the axial direction of the motoriAnd a rotational moment Mi,Fi=kFωi 2,Mi=kMωi 2Wherein k isFIs the coefficient of rotation of the motor, kMIs the motor rotation torque coefficient;
the control distributor is designed as follows:
Figure BDA0003164533190000031
wherein L is the wheel base between two motors arranged in the same direction,
Figure BDA0003164533190000032
for the drive torque control signal described in the body coordinate system,
Figure BDA0003164533190000033
the desired roll angular velocities for the six motors.
Preferably, a torque-driven control distribution strategy is adopted in the third step, that is, two motors arranged on the same diameter adopt control signals with equal size and the same direction.
In summary, due to the adoption of the technical scheme, the invention has the beneficial effects that:
1. the invention realizes the control of the six-rotor spherical robot. Firstly, inputting the acquired track navigation and position information acquired by a position sensor into a position controller to obtain an expected rolling angular velocity; inputting the expected rolling angular speed and the measured angular speed data into an attitude controller, calculating angular speed deviation, and outputting expected driving moment; the control distributor calculates the expected driving torque into control signals of the six motors according to the spatial configuration of the arrangement of the motors in the six-rotor spherical robot and the detected current attitude information, so that the spherical robot is driven to move according to a preset track through the control of the motors.
2. The invention simplifies the control model and reduces the control difficulty. According to the spatial configuration arrangement of the motors, in order to avoid the phenomenon that the model coupling is too strong due to the reaction torque generated by the rotors in the rotating process, the invention adopts a torque-driven control distribution strategy, namely two motors arranged on the same diameter adopt control signals with equal size and the same direction, and under the control distribution strategy, the control signals of 6 rotors can be practically equivalent to 3 paths of rotating speed control signals, so that the simplification effect is achieved.
3. According to the invention, a control strategy for motors is designed according to the spatial configuration of the arrangement of the motors in the six-rotor spherical robot, and different actions of the robot are realized through the control coordination among the motors, so that the six-rotor spherical robot is accurately controlled.
Drawings
The invention will now be described, by way of example, with reference to the accompanying drawings, in which:
fig. 1 is a schematic diagram of the overall structure of a hardware platform six-rotor spherical robot on which the present invention is based.
Fig. 2 is a layout diagram of motors and rotors in a six-rotor spherical robot.
Fig. 3 is a schematic diagram of a control system of a six-rotor spherical robot in an embodiment of the present invention.
Fig. 4 is a schematic diagram of the inertial coordinate system and the body coordinate system established in the present invention.
Fig. 5 is a graph of the effect of the trajectory control achieved by the present invention.
Fig. 6 is a graph showing the effect of the pitch channel control in practical tests of the present invention.
Fig. 7 is a graph showing the effect of the roll channel control in the practical test of the present invention.
The labels in the figure are: the structure of the robot comprises a spherical shell 1, an upper hemispherical shell 10, a lower hemispherical shell 11, a hole 12, an X-axis support 20, a Y-axis support 21, a Z-axis support 22, a lower motor 40, an upper motor 41, a right motor 42, a left motor 43, a front motor 44, a rear motor 45, a rotor 5 and a blade 6.
Detailed Description
All of the features disclosed in this specification, or all of the steps in any method or process so disclosed, may be combined in any combination, except combinations of features and/or steps that are mutually exclusive.
Any feature disclosed in this specification (including any accompanying claims, abstract) may be replaced by alternative features serving equivalent or similar purposes, unless expressly stated otherwise. That is, unless expressly stated otherwise, each feature is only an example of a generic series of equivalent or similar features.
As shown in fig. 1, the housing of the six-rotor spherical robot is a spherical housing 1, and a hole 12 is formed on the spherical housing 1; in the embodiment, a hollow spherical shell is preferred, and the hollow design is adopted, so that the air flow of the paddle can conveniently pass through. The spherical shell is divided into two hemispherical shells, an upper hemispherical shell 10 and a lower hemispherical shell 11, which can be conveniently opened and closed.
A bracket is fixed in the spherical shell, and a driving mechanism for driving the spherical shell to roll forward, spin and balance left and right is arranged on the bracket; the driving mechanism comprises a motor and a rotor wing arranged on the motor. At least six driving mechanisms are mounted on the bracket, and the six driving mechanisms comprise six motors and six rotors; the rotor includes at least one blade. The support comprises an X-axis support, a Y-axis support and a Z-axis support which pass through the same middle point.
As shown in fig. 2, driving mechanisms are symmetrically mounted at both ends of the X-axis support 20, the Y-axis support 21 and the Z-axis support 22, respectively; the drive mechanism comprises an electric motor, and a rotor 5 mounted on the electric motor. A motor and a rotor wing 5 are respectively and reversely arranged on each X-axis bracket 20, each Y-axis bracket 21 and each Z-axis bracket 22, an upper motor 41 and a lower motor 40 are respectively arranged on each X-axis bracket 20, each upper motor 41 is provided with the rotor wing 5 to generate an upward acting force, each lower motor 40 is provided with the rotor wing 5 to generate a downward acting force, and the left and right leveling of the spherical robot is realized by controlling the upper and lower motors; a left motor 43 and a right motor 42 are respectively arranged on the Y-axis support 21, a rotor wing 5 is arranged on the left motor 43 to generate a leftward acting force, a rotor wing 5 is arranged on the right motor 42 to generate a rightward acting force, and the rotation of the spherical robot is realized by controlling the left motor and the right motor; the Z-axis bracket 22 is respectively provided with a front motor 44 and a rear motor 45, the front motor 44 is provided with a rotor wing 5 to generate a forward acting force, the rear motor 45 is provided with a rotor wing 5 to generate a backward acting force, and the front motor and the rear motor are controlled to realize the front-back rolling of the spherical robot.
And a camera is also arranged in the spherical shell and used as a payload to detect the surrounding environment. An autopilot, an electric regulator, a power supply, a position indicator and a task computer are also arranged in the spherical shell; the automatic pilot is used for controlling the movement of the spherical robot; the electric regulator is used for converting direct current provided by a power supply into alternating current of the driving motor; the positioning instrument is used for acquiring positioning information; and the task computer is used for acquiring, processing and transmitting the load data and realizing autonomous planning and re-planning tasks. And the spherical shell is also internally provided with a data transmission and an image transmission which are communicated with the ground station and used for image transmission.
As shown in fig. 3, the present invention provides a control system of a six-rotor spherical robot, comprising a position controller, an attitude controller, a control distributor and rigid body dynamics (spherical rolling dynamics module); the position controller inputs the track waypoint and the current position information received by the sensor, calculates deviation, outputs expected rolling angular velocity and transmits the expected rolling angular velocity to the attitude controller; the attitude controller inputs the expected rolling angular speed and the angular speed data measured by the sensor, calculates the angular speed deviation, outputs the expected driving moment and transmits the expected driving moment to the control distributor; the control distributor resolves the expected driving torque into a control signal of the motor according to the spatial configuration of the motor arrangement in the six-rotor spherical robot and the current attitude information; and the spherical rolling dynamics module outputs position information, angular velocity data and attitude information measured by corresponding sensors to the position controller, the attitude controller and the control distributor respectively.
The invention provides a track control method of a six-rotor spherical robot, which comprises the following steps:
acquiring waypoint data of a track planner and position information acquired by a position sensor as first-level input; performing integral separation by using a PID algorithm, and obtaining an expected rolling angular velocity through a position controller to be used as the input of a second-stage PID;
inputting expected rolling angular velocity and angular velocity data measured by a gyroscope into an attitude controller, calculating angular velocity deviation, outputting expected driving moment, and transmitting the expected driving moment to a control distributor;
the control distributor resolves the expected driving torque into control signals of the six motors according to the space configuration of the motor arrangement in the six-rotor spherical robot and the current attitude information;
based on a spherical rolling dynamics model, under the synergistic effect of six rotors, the spherical robot can realize accurate and stable control according to a preset track.
In an embodiment, a trajectory control method of a six-rotor spherical robot is disclosed, comprising the following steps:
s101: acquiring waypoint data and position information obtained by a position sensor as first-stage input, performing integral separation by using a PID algorithm, and obtaining an expected rolling angular velocity through a position controller as second-stage PID input;
the method specifically comprises the following steps: and the waypoint data is obtained by discretizing a preset track, and the tracking process of switching to the next navigation section when the current position of the target waypoint on each navigation section crosses the navigation method plane where the waypoint is located. The position sensor obtains position information by using an indoor optical motion capture system OptiTrack, and the position sensor needs to be subjected to mean value filtering processing due to certain fluctuation; and the processed data is subjected to Kalman filtering, so that the position data is more real and reliable. Then, a discretized position type PID algorithm is used for controlling the expected rolling angular speed, integral separation is used for avoiding integral saturation, and the calculation formula is as follows:
Figure BDA0003164533190000051
wherein, KpIs a proportionality coefficient, KIIs the integral coefficient, KDIs the differential coefficient, e is the deviation of the desired position from the actual position,
Figure BDA0003164533190000052
calculating a desired roll angular velocity for the position controller;
s102: inputting expected rolling angular velocity and angular velocity data measured by a gyroscope into an attitude controller, calculating angular velocity deviation, outputting expected driving moment, and transmitting the expected driving moment to a control distributor;
specifically, the spherical robot can be simplified into an under-actuated rolling sphere with two orthogonal inputs, as shown in fig. 4, an inertial coordinate system oexyz and a body coordinate system CX of the spherical robot are established respectively with a motion origin O and a sphere center point C as originsBYBZB5 parameters can be selected to describe the pure rolling motion of the spherical robot along a smooth horizontal plane: coordinates of the sphere center C (x, y) and 3 Euler angles:
Figure BDA0003164533190000061
θ、ψ。
the expected rolling angular velocity data calculated by the position controller is based on the inertial coordinate system OXYZ as a reference system and is recorded as
Figure BDA0003164533190000062
The angular velocity data measured by the gyro sensor is the airframe coordinate system CX where the flight control itself is locatedBYBZBAs a reference system, denoted as ωB(ii) a Constructing angular acceleration control signals through PI controllers
Figure BDA0003164533190000063
Figure BDA0003164533190000064
Wherein, the first and the second end of the pipe are connected with each other,
Figure BDA0003164533190000065
desired roll angular velocity, ω, calculated for the position controllereThe calculation formula is described in an inertial coordinate system for the angular velocity data measured by the gyroscope sensor, and the calculation formula is as follows:
ωe=Rb2eωB
Figure BDA0003164533190000066
wherein c represents cos and s represents sin.
According to the kinematic characteristics of the sphere, the angular acceleration control signal described in the inertial coordinate system is resolved into a driving torque control signal described in the body coordinate system
Figure BDA0003164533190000067
Figure BDA0003164533190000068
Wherein I is an inertia matrix;
s103: the control distributor resolves the expected driving torque into control signals of the six motors according to the space configuration of the motor arrangement in the six-rotor spherical robot and the current attitude information;
specifically, the control distribution is performed according to the motor space arrangement configuration of the six-rotor spherical robot shown in fig. 1 and 2. For a six-rotor spherical robot, our control means is to control the rotation speed of six rotors. First, the effect of the rotational speed ω is analyzed, and it is assumed that the rotational speed of the rotor i (i is 1,2, …,6) is desired to be ωiThen its effect can be resolved into the lifting force F in the axial direction of the motoriAnd a rotational moment MiThe relationship is:
Fi=kFωi 2
Mi=kMωi 2
wherein k isFIs the coefficient of rotation of the motor, kMIs the motor rotation torque coefficient.
According to the spatial configuration arrangement of the motors, in order to avoid the phenomenon that the model coupling is too strong due to the reaction torque generated by the rotors in the rotating process, the invention adopts a torque-driven control distribution strategy, namely two motors arranged on the same diameter adopt control signals with equal size and the same direction, under the control distribution strategy, the control signals of 6 rotors can be practically equivalent to 3 paths of rotating speed control signals, and the control distribution device is designed as follows:
Figure BDA0003164533190000071
wherein, L is the wheel base between two motors arranged in the same direction.
As shown in FIG. 5, the invention achieves very good track control effect in practical test, and improves the control precision of the spherical robot. As shown in fig. 6, the difference between the pitch input angular rate and the actual angular rate is small, which proves that the pitch channel control effect of the invention is good in the actual test. As shown in FIG. 7, the roll input angular rate and the actual angular rate are compared and are relatively close to each other, which shows that the roll channel control effect of the present invention is good in practical test. Through actual tests, test results prove that under the control of the track control method, the six-rotor spherical robot can realize accurate and stable control according to a preset track.
The invention is not limited to the foregoing embodiments. The invention extends to any novel feature or any novel combination of features disclosed in this specification and any novel method or process steps or any novel combination of features disclosed.

Claims (8)

1. A track control method of a six-rotor spherical robot is characterized in that a cascade PID algorithm is adopted for track control; the cascade PID algorithm specifically comprises the following steps:
the method comprises the following steps: acquiring track waypoints and position information obtained by a position sensor as primary PID input, and performing integral separation by using a PID algorithm to obtain an expected rolling angular velocity;
step two: taking the expected rolling angular speed and the measured angular speed data as the input of a second-stage PID, calculating the angular speed deviation, and outputting expected driving torque;
step three: according to the spatial configuration of the arrangement of the motors in the six-rotor spherical robot and the detected current attitude information, the expected driving torque is resolved into control signals of the six motors;
the second step specifically comprises: constructing an angular velocity control signal described under an inertial coordinate system through a PI controller
Figure FDA0003665043970000011
Figure FDA0003665043970000012
Wherein the content of the first and second substances,
Figure FDA0003665043970000013
to roll as desiredDynamic angular velocity, omegaeA description of the angular velocity data measured by the sensor in an inertial coordinate system; the omegaeThe calculation formula of (2) is as follows:
ωe=Rb2eωB
Figure FDA0003665043970000014
wherein, ω isBThe angular velocity data measured for the sensor are described in the body coordinate system as a reference system, c represents cos, s represents sin,
Figure FDA0003665043970000015
theta, psi are 3 Euler angles;
angular acceleration control signal described under inertial coordinate system
Figure FDA0003665043970000016
Resolving into a drive torque control signal described in a body coordinate system
Figure FDA0003665043970000017
Figure FDA0003665043970000018
Where I is the inertia matrix.
2. The trajectory control method of a six-rotor spherical robot according to claim 1, wherein the position information obtained by the position sensor in the first step is subjected to a mean filtering process and a kalman filtering process in this order.
3. The trajectory control method of a hexa-rotor spherical robot according to claim 1 or 2, wherein in the first step, the integration and separation are performed by using a PID algorithm, and the method for obtaining the desired rolling angular velocity is as follows: and replacing the original differential by the product of the proportional coefficient and the derivative of the input value, performing integral separation on the deviation differential, and outputting the expected rolling angular speed based on the calculation result.
4. The trajectory control method of a six-rotor spherical robot according to claim 3, wherein the desired roll angular velocity is calculated by the formula:
Figure FDA0003665043970000019
wherein, KpIs a proportionality coefficient, kIIs an integral coefficient, kDIs the differential coefficient, e is the deviation of the desired position from the actual position,
Figure FDA0003665043970000021
is the desired roll angular velocity.
5. The trajectory control method of a six-rotor spherical robot according to claim 1, wherein the third step specifically comprises: the rotating speed of the rotor wing i is set to reach omegaiI is 1,2, …,6, the action effect is decomposed into a lift force F in the axial direction of the motoriAnd a rotational moment Mi,Fi=kFωi 2,Mi=kMωi 2Wherein k isFIs the coefficient of rotation of the motor, kMIs the motor rotation torque coefficient;
the control distributor is designed as follows:
Figure FDA0003665043970000022
wherein L is the wheel base between two motors arranged in the same direction,
Figure FDA0003665043970000023
for the drive torque control signal described in the body coordinate system,
Figure FDA0003665043970000024
the desired roll angular velocities for the six motors.
6. The trajectory control method of a six-rotor spherical robot according to claim 1, wherein a torque-driven control distribution strategy is adopted in the third step, that is, two motors arranged on the same diameter adopt control signals with equal magnitude and the same direction.
7. A control system of a six-rotor spherical robot, characterized in that the trajectory control method of the six-rotor spherical robot according to any one of claims 1 to 6 is adopted, comprising a position controller, an attitude controller, a control distributor;
the position controller inputs the track waypoint and the current position information received by the sensor, calculates deviation, outputs expected rolling angular velocity and transmits the expected rolling angular velocity to the attitude controller;
the attitude controller inputs the expected rolling angular speed and the angular speed data measured by the sensor, calculates the angular speed deviation, outputs the expected driving moment and transmits the expected driving moment to the control distributor;
the control distributor is used for resolving the expected driving torque into a control signal of the motor according to the spatial configuration of the motor arrangement in the six-rotor spherical robot and the current attitude information.
8. The control system for a six-rotor spherical robot according to claim 7, further comprising a spherical rolling dynamics module for outputting position information, angular velocity data, and attitude information measured by the corresponding sensors to the position controller, the attitude controller, and the control distributor, respectively.
CN202110800514.5A 2021-07-15 2021-07-15 Control system of six-rotor spherical robot and trajectory control method thereof Active CN113433820B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110800514.5A CN113433820B (en) 2021-07-15 2021-07-15 Control system of six-rotor spherical robot and trajectory control method thereof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110800514.5A CN113433820B (en) 2021-07-15 2021-07-15 Control system of six-rotor spherical robot and trajectory control method thereof

Publications (2)

Publication Number Publication Date
CN113433820A CN113433820A (en) 2021-09-24
CN113433820B true CN113433820B (en) 2022-07-05

Family

ID=77760563

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110800514.5A Active CN113433820B (en) 2021-07-15 2021-07-15 Control system of six-rotor spherical robot and trajectory control method thereof

Country Status (1)

Country Link
CN (1) CN113433820B (en)

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101590323B (en) * 2009-07-08 2012-10-31 北京工业大学 Single-wheel robot system and control method thereof
CN103135549A (en) * 2012-12-21 2013-06-05 北京邮电大学 Motion control system and motion control method for spherical robot with visual feedback
US11640178B2 (en) * 2016-12-13 2023-05-02 Acsl Ltd. Unmanned aircraft, device for controlling unmanned aircraft, method for controlling unmanned aircraft, and device for detecting failure of unmanned aircraft
CN107272725B (en) * 2017-08-08 2020-08-25 广州一衍信息科技有限公司 Spherical robot motion control system with visual feedback and motion control method
CN110488598A (en) * 2019-08-07 2019-11-22 清华大学 Air-ground amphibious unmanned vehicle control
CN110888447B (en) * 2019-12-23 2021-09-03 西安电子科技大学 Four-rotor-wing 3D path tracking method based on nonlinear PD double closed-loop control
CN112034871B (en) * 2020-08-25 2022-05-24 南京航空航天大学 Omnidirectional control method of tiltable multi-rotor aircraft
CN112684805B (en) * 2021-01-14 2021-11-23 北京航空航天大学 High-mobility micro unmanned aerial vehicle control method considering attitude constraint

Also Published As

Publication number Publication date
CN113433820A (en) 2021-09-24

Similar Documents

Publication Publication Date Title
Azfar et al. A simple approach on implementing IMU sensor fusion in PID controller for stabilizing quadrotor flight control
US20210141395A1 (en) Stable flight control method for multi-rotor unmanned aerial vehicle based on finite-time neurodynamics
Kaufman et al. Design and development of a free-floating hexrotor UAV for 6-DOF maneuvers
CN109460052A (en) A kind of control method for spelling group aircraft
Kastelan et al. Fully actuated tricopter with pilot-supporting control
Suprijono et al. Direct inverse control based on neural network for unmanned small helicopter attitude and altitude control
Manjunath et al. Application of virtual target based guidance laws to path following of a quadrotor UAV
CN106774374A (en) A kind of unmanned plane automatic detecting method and system
Limnaios et al. Fuzzy logic controller for a mini coaxial indoor helicopter
Tao et al. Modeling and control of swing oscillation of underactuated indoor miniature autonomous blimps
JP5493103B2 (en) Simple manual flight control system for unmanned flying vehicles
JP2001306144A (en) Flight control system for unmanned helicopter
Sato et al. A simple autonomous flight control of multicopter using only web camera
Lugo-Cardenas et al. The mav3dsim hardware in the loop simulation platform for research and validation of uav controllers
Stingu et al. Design and implementation of a structured flight controller for a 6DoF quadrotor using quaternions
Sa et al. Dynamic system identification, and control for a cost-effective and open-source multi-rotor mav
CN113433820B (en) Control system of six-rotor spherical robot and trajectory control method thereof
Partovi et al. Development of a cross style quadrotor
Schafroth Aerodynamics, modeling and control of an autonomous micro helicopter
Buskey et al. Sensing and control for a small-size helicopter
Bonci et al. The Double Propeller Ducted-Fan, an UAV for safe Infrastructure inspection and human-interaction
Lyu et al. A novel integrated navigation system based on the quadrotor dynamic model
Harkare et al. Design and Control of a Quadcopter
Kuantama et al. Quadcopter attitude and thrust simulation based on Simulink platform
Zhao et al. Vision-based robust position control for ground target tracking and hovering of quadrotors

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