WO2022134036A1 - Movable platform and control method and device therefor - Google Patents

Movable platform and control method and device therefor Download PDF

Info

Publication number
WO2022134036A1
WO2022134036A1 PCT/CN2020/139528 CN2020139528W WO2022134036A1 WO 2022134036 A1 WO2022134036 A1 WO 2022134036A1 CN 2020139528 W CN2020139528 W CN 2020139528W WO 2022134036 A1 WO2022134036 A1 WO 2022134036A1
Authority
WO
WIPO (PCT)
Prior art keywords
movable platform
mode
load
gimbal
motion
Prior art date
Application number
PCT/CN2020/139528
Other languages
French (fr)
Chinese (zh)
Inventor
刘力源
谢振生
Original Assignee
深圳市大疆创新科技有限公司
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 深圳市大疆创新科技有限公司 filed Critical 深圳市大疆创新科技有限公司
Priority to PCT/CN2020/139528 priority Critical patent/WO2022134036A1/en
Priority to CN202080073976.5A priority patent/CN114641746A/en
Publication of WO2022134036A1 publication Critical patent/WO2022134036A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64UUNMANNED AERIAL VEHICLES [UAV]; EQUIPMENT THEREFOR
    • B64U20/00Constructional aspects of UAVs
    • B64U20/80Arrangement of on-board electronics, e.g. avionics systems or wiring
    • B64U20/87Mounting of imaging devices, e.g. mounting of gimbals
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00Stands or trestles as supports for apparatus or articles placed thereon Stands for scientific apparatus such as gravitational force meters
    • F16M11/02Heads
    • F16M11/04Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand
    • F16M11/06Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00Stands or trestles as supports for apparatus or articles placed thereon Stands for scientific apparatus such as gravitational force meters
    • F16M11/02Heads
    • F16M11/04Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand
    • F16M11/06Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting
    • F16M11/12Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting in more than one direction
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00Stands or trestles as supports for apparatus or articles placed thereon Stands for scientific apparatus such as gravitational force meters
    • F16M11/02Heads
    • F16M11/16Details concerning attachment of head-supporting legs, with or without actuation of locking members thereof
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00Stands or trestles as supports for apparatus or articles placed thereon Stands for scientific apparatus such as gravitational force meters
    • F16M11/02Heads
    • F16M11/18Heads with mechanism for moving the apparatus relatively to the stand
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M13/00Other supports for positioning apparatus or articles; Means for steadying hand-held apparatus or articles
    • F16M13/02Other supports for positioning apparatus or articles; Means for steadying hand-held apparatus or articles for supporting on, or attaching to, an object, e.g. tree, gate, window-frame, cycle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/10Simultaneous control of position or course in three dimensions
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M2200/00Details of stands or supports
    • F16M2200/04Balancing means
    • F16M2200/041Balancing means for balancing rotational movement of the head

Definitions

  • the present application relates to the technical field of movable platforms, and more particularly, to a control method of a movable platform, a computer-readable storage medium, a control device of a movable platform, a movable platform, and a movable platform assembly.
  • the movable platform can carry the load through the gimbal to realize the control of the attitude of the load.
  • the attitude control methods of the movable platform body are diverse, and the control methods of the gimbal to the load attitude are also diverse, so that users need to consider the control of the movable platform body and the gimbal at the same time, but When the user faces a complex scene and needs to frequently operate or switch the functions of the movable platform and the PTZ, the operation difficulty of the movable platform is increased, and the user experience is reduced.
  • a method for controlling a movable platform, a computer readable storage medium, a control device for a movable platform, a movable platform, and a movable platform assembly are provided to overcome the above problems or at least partially solve the above problems.
  • a control method for a movable platform comprising: acquiring a current motion mode of the movable platform, wherein the movable platform has multiple motions In different motion modes, the movable platform has different control methods, and the movable platform includes a pan/tilt for carrying loads and a support mechanism for supporting the pan/tilt; according to the movement of the movable platform In the current motion mode, it is determined that the gimbal enters a corresponding gimbal mode, where the gimbal mode includes a stabilization mode for maintaining a stable attitude of the payload to the ground, and a stabilization mode for maintaining the payload The following mode is stable relative to the posture of the support mechanism.
  • a computer-readable storage medium storing executable instructions that, when executed by one or more processors, cause the one or more processors to The processor executes the control method provided by the first aspect of the present application.
  • a control apparatus for a mobile platform comprising: a memory for storing executable instructions; a processor for executing the executable instructions stored in the memory Execute the instruction to perform the following operations: obtain the current motion mode of the movable platform, wherein the movable platform has multiple motion modes, and the control modes of the movable platform under different motion modes are different, so
  • the movable platform includes a pan-tilt for carrying loads and a support mechanism for supporting the pan-tilt; according to the motion mode that the movable platform is currently in, it is determined that the pan-tilt enters a corresponding pan-tilt mode , the pan-tilt mode includes a stabilization mode for keeping the attitude of the load relative to the ground stable, and a follow mode for keeping the relative attitude of the load and the support mechanism stable.
  • a movable platform includes a pan-tilt for carrying loads and a support mechanism for supporting the pan-tilt; the movable platform further comprises: a memory for storing executable instructions; a processor for executing the executable instructions stored in the memory to perform the following operations: acquiring the motion mode currently in which the movable platform is located, wherein the executable instructions
  • the mobile platform has multiple motion modes, and the control modes of the movable platform under different motion modes are different;
  • the gimbal mode includes a stabilization mode for maintaining a stable attitude of the load to the ground, and a following mode for keeping the relative posture of the load and the support mechanism stable.
  • a movable platform assembly includes: any of the movable platforms described above; a remote control terminal, wherein the remote control terminal is communicatively connected to the movable platform, It is used to control the movable platform, wherein the movement mode of the movable platform can be switched by the remote control terminal.
  • the movable platform can have two pan-tilt modes, namely stabilization mode and follow mode.
  • the stabilization mode the movable platform can be used to capture images of stable images.
  • the mobile platform may allow the user to experience the first-person perspective of the mobile platform.
  • the present application obtains the current motion mode of the movable platform, and determines that the gimbal enters the corresponding gimbal mode, that is, the stabilization mode or the follow mode, according to the obtained result. Therefore, the gimbal controls the load attitude in a simple and convenient manner. It is fast and reduces the difficulty of operating the mobile platform.
  • control method of the gimbal to the load attitude can be adapted to the current motion mode of the movable platform, so that the control method of the gimbal to the load attitude can satisfy the current movement mode of the movable platform.
  • FIG. 1 is a schematic structural diagram of a movable platform according to an embodiment of the present application.
  • FIG. 2 is a schematic diagram of a gimbal of a movable platform in a stabilization mode according to an embodiment of the present application
  • FIG. 3 is a schematic diagram of a pan/tilt head of a movable platform in a follow mode according to an embodiment of the present application
  • FIG. 4 is a schematic diagram of a movable platform in a first motion mode according to an embodiment of the present application
  • FIG. 5 is a schematic diagram of the movable platform in a second motion mode according to an embodiment of the present application.
  • FIG. 6 is a schematic diagram of the movable platform in a third motion mode according to an embodiment of the present application.
  • FIG. 7 is a schematic diagram of a movable platform in a third motion mode in response to a user input instruction according to an embodiment of the present application
  • FIG. 8 is a schematic diagram of the movable platform in a fourth motion mode according to an embodiment of the present application.
  • FIG. 9 is a schematic diagram when the gimbal of the movable platform enters the stabilization mode from the follow mode according to an embodiment of the present application.
  • FIG. 10 is a schematic diagram when the gimbal of the movable platform enters the follow mode from the stabilization mode according to an embodiment of the present application
  • FIG. 11 is a control principle diagram when the gimbal of the movable platform is in the stabilization mode according to an embodiment of the present application
  • Fig. 12 is a control principle diagram when the pan/tilt of the movable platform is in a follow mode according to an embodiment of the present application
  • FIG. 13 is a control principle diagram when the pan/tilt of the movable platform is in a follow mode according to another embodiment of the present application.
  • 10 is a movable platform
  • 100 is a load
  • 200 is a head
  • 300 is a support mechanism
  • 400 is a positioning device
  • 500 is a detection device.
  • first and second are only used for description purposes, and cannot be interpreted as indicating or implying relative importance or implicitly indicating the number of indicated technical features.
  • features defined as “first” and “second” may expressly or implicitly include, but are not limited to, one or more of said features.
  • This embodiment first provides a control method for a movable platform, where the movable platform includes a pan-tilt for carrying loads and a support mechanism for supporting the pan-tilt.
  • the support mechanism may include but not limited to the chassis of the unmanned vehicle, the fuselage of the robot or the fuselage of the drone. That is, the movable platform may include unmanned vehicles, drones, or robots.
  • the payload may be an imaging device, for example, a camera, a video camera, etc., specifically, a single-lens reflex camera, a mirrorless camera, and the like.
  • the load may be a smart terminal, such as a mobile phone, tablet, etc. with a photographing function.
  • the payload may also be other devices that need to be moved, manipulated, or attitude adjusted, such as a microphone.
  • the PTZ may include one PTZ component, two PTZ components, three PTZ components or more PTZ components. Accordingly, the head may allow the load to rotate about one, two, three or more axes, and the axes for rotation may or may not be orthogonal to each other.
  • the gimbal component can control the attitude of the payload through a motor, including controlling one or more of the payload's pitch angle, roll angle, and yaw angle. Accordingly, the payload may rotate about one or more of the pitch axis P, the roll axis R, and the yaw axis Y.
  • each pan/tilt member may include a connecting arm.
  • the first pan-tilt member is connected to the support mechanism, and the first pan-tilt member can rotate relative to the support mechanism, so that the yaw angle of the load changes, that is, when the first connecting arm rotates relative to the support mechanism, the load can be rotated around the yaw angle.
  • the Y axis rotates.
  • the second pan-tilt part is connected to the first pan-tilt part, and the second pan-tilt part can rotate relative to the support mechanism, so that the roll angle of the load changes, that is, when the second pan-tilt part rotates relative to the support mechanism, the load can be rotated Rotate around the roll axis R.
  • the third pan-tilt part is connected with the second pan-tilt part, and the third pan-tilt part can rotate relative to the support mechanism, so that the pitch angle of the load changes, that is, when the third pan-tilt part rotates relative to the support mechanism, the load can be rotated around the support mechanism.
  • the pitch axis P rotates.
  • the pan/tilt may include only one pan/tilt component.
  • the head part can be rotated relative to the support mechanism to change the yaw angle of the load, that is, when the head part is rotated relative to the support mechanism, the load can be rotated around the yaw axis Y.
  • the gimbal connected to the drone body can have one gimbal part, two gimbal parts, three gimbal parts or more gimbal parts, and can The load can be rotated about one, two or three of the pitch, roll and yaw axes, so that the load can also be rotated about more axes, etc.
  • the gimbal can also have one gimbal part, two gimbal parts, three gimbal parts or more than three gimbal parts, and the load can be Rotate about one, two or three of the pitch, roll, and yaw axes, so that the load can also rotate about more than three axes, etc. That is to say, regardless of the type of support mechanism, the gimbal can be a single-axis gimbal, a two-axis gimbal, a three-axis gimbal or a gimbal with other axes.
  • FIG. 1 is a schematic structural diagram of a movable platform according to an embodiment of the present application, and the movable platform 10 is an example of an unmanned aerial vehicle.
  • UAVs are also commonly referred to as UAVs (Unmanned Aerial Vehicles), wherein UAVs can include fixed-wing UAVs, rotary-wing UAVs, umbrella-wing UAVs, etc. .
  • the connection between the gimbal 200 and the fuselage of the UAV is not limited to the position shown in FIG. 1 , that is, the gimbal 200 can not only be connected to the bottom of the UAV, but also can be connected to the UAV.
  • the top and side parts are connected to each other, which is not limited in this embodiment.
  • the movable platform may be an unmanned vehicle, eg, a remotely controlled unmanned vehicle.
  • the support mechanism may include the chassis of the unmanned vehicle.
  • the chassis can be used to support the gimbal, and the movement of the chassis can be directly moved by wheels, or by other mechanisms such as crawlers.
  • the number of wheels of the unmanned vehicle may be one or more, which is not limited in this embodiment.
  • the movable platform may be a robot.
  • the support mechanism may then comprise the body of the robot. It can be understood that the pan/tilt can be connected not only to the head of the robot body, but also to other parts of the robot body such as the robot arm and the back of the robot, which is not limited in this embodiment.
  • the gimbal has a stabilization mode for keeping the ground attitude of the load stable and a follow mode for keeping the relative attitude of the load and the support mechanism stable.
  • FIG. 2 is a schematic diagram of the gimbal of the movable platform in a stabilization mode according to an embodiment of the present application
  • FIG. 3 is a schematic diagram of the gimbal of the movable platform in a follow mode according to an embodiment of the present application.
  • the stabilization mode when the movable platform 10 is in the stabilization mode, since the gimbal 200 is used to keep the ground-facing attitude of the payload 100 stable, even if the attitude of the support mechanism 300 changes, the orientation of the payload 100 to the ground is stable. The ground attitude is also stable. Therefore, in the stabilization mode, when the payload 100 is an imaging device, the imaging device can be stabilized for imaging, and it is understandable that when the movable platform 10 is an unmanned aerial vehicle, aerial photography can be performed. In the stabilization mode, when the load 100 is a microphone, the microphone can be made to collect stable sound.
  • the movable platform 10 when the movable platform 10 is in the follow mode, since the gimbal 200 is used to keep the relative posture of the load 100 and the support mechanism 300 stable, when the posture of the support mechanism 300 changes, the load 100 The posture will also change. Therefore, in the follow mode, when the payload 100 is an imaging device, the imaging device can be made to take an image from a first-person perspective. Understandably, when the movable platform 10 is a drone, the user can experience a first-person perspective. flight. In the follow mode, when the load is a microphone, the microphone can be made to collect the sound corresponding to the first-person perspective.
  • the control method of the movable platform includes: acquiring the motion mode that the movable platform is currently in, wherein the movable platform has multiple motion modes, and the control modes of the movable platform under different motion modes are different;
  • the current motion mode of the HMI determines that the gimbal enters the corresponding gimbal mode.
  • the movable platform may have two pan/tilt modes, namely stabilization mode and follow mode.
  • the stabilization mode the movable platform can be used to capture images of stable images.
  • the movable platform can enable the user to experience the first-person perspective of the movable platform.
  • the current motion mode of the movable platform is obtained, and it is determined according to the obtained result that the gimbal enters the corresponding gimbal mode, that is, the stabilization mode or the follow mode. There is no need for additional active adjustment by the user, which reduces the operation difficulty of the movable platform.
  • control method of the gimbal to the load attitude can be adapted to the current motion mode of the movable platform, so that the control method of the gimbal to the load attitude can satisfy the current movement mode of the movable platform.
  • the execution body of the embodiment of the present application may be a remote control terminal of the movable platform, or may be a controller of the movable platform, so as to control the PTZ to enter the corresponding PTZ after determining the corresponding PTZ mode. mode, and adjust the posture accordingly.
  • the movable platform may further include a positioning device and a detection device, the positioning device is used for acquiring the position information of the movable platform, and the detection device is used for detecting the surrounding obstacle information of the movable platform.
  • the use states of the positioning device and/or the detection device are different, so that the movable platform has different control modes. That is to say, between different motion modes, only the use state of the positioning device may be different, or only the use state of the detection device may be different, or the use state of the positioning device and the detection device may be different.
  • the different usage states of the positioning device and/or the detection device can make the movable platform have different control modes, for example, a control mode suitable for capturing stable images or capturing a stable sound, and a control mode suitable for users to experience the first-person perspective.
  • the control method of the viewing angle experience therefore, this motion mode corresponds to the different modes of the gimbal, which can meet the diverse needs of users.
  • the control range of the movement parameter (moving speed) of the movable platform can be different, and the movable platform can be moved.
  • the control of the motion parameters of the platform may be affected by the user's instructions in different ways (for example, in the case of different use states of the positioning device and/or the detection device, the types of the motion parameters to be controlled are different, so that the control of the movable platform can be different. (for example, when the movable platform is an aircraft, in the case of different usage states of the positioning device and/or the detection device, the aircraft may be allowed to hover by allowing the Changed to not allow hovering).
  • the movable platform when the movable platform has a relatively fast movement speed, it corresponds to the follow mode, and when the movable platform has a relatively slow movement speed, it corresponds to the stabilization mode; the movement parameters of the movable platform are controlled by the user. When the influence of the command is large, it corresponds to the follow mode. When the control of the motion parameters of the movable platform is less affected by the user's command, it corresponds to the stabilization mode.
  • the movable platform is an aircraft, the aircraft can hover and correspond to the stabilization mode. , the aircraft cannot implement hovering and following mode.
  • the plurality of motion modes may include a first motion mode
  • FIG. 4 is a schematic diagram of the movable platform according to an embodiment of the present application when the movable platform is in the first motion mode.
  • the use state of the positioning device 400 is turned on, and the use state of the detection device 500 is to turn on the surrounding obstacle information for the movable platform 100 in the first direction and The function of visual obstacle avoidance in the second direction.
  • the surrounding obstacle information is used for the visual obstacle avoidance of the movable platform 100 in the first direction may include: surrounding obstacle information is used to control the moving speed of the movable platform 100 in the first direction, for example, when the surrounding obstacle information indicates that the When there is an obstacle in the preset distance in the first direction, the speed of the movable platform in the first direction is reduced or the movement of the movable platform in the first direction is prohibited.
  • the surrounding obstacle information is used for the visual obstacle avoidance of the movable platform 100 in the second direction may include: surrounding obstacle information is used to control the moving speed of the movable platform 100 in the second direction, for example, when the surrounding obstacle information indicates that the When there is an obstacle in the preset distance in the second direction, the speed of the movable platform in the second direction is reduced or the movement of the movable platform in the second direction is prohibited.
  • the positioning device 400 can obtain the position information of the movable platform 10.
  • the obtained position information can be used for For controlling the position of the movable platform 10 , it may not be used for controlling the position of the movable platform 10 .
  • the positioning device may include a global positioning system, and the global positioning system can position all-weather around the world, and has the advantages of high positioning accuracy and short observation time.
  • the positioning device may also include a strapdown inertial navigation system, a wireless positioning system, or the like.
  • the detection means may comprise a visual positioning system. Therefore, the detection device can not only be used to detect the surrounding obstacle information of the movable platform, but also can be used to obtain the position information of the movable platform when the reliability of the positioning device is low and the reliability of the detection device is relatively high. That is to say, when the reliability of the positioning device is high, the position of the movable platform can be controlled by the position information obtained by the positioning device. When the reliability of the positioning device is low and the reliability of the detection device is high, The position of the movable platform can be controlled by the position information obtained by the detection device.
  • the detection device may further include a visual sensor, a device for detecting information about obstacles around the movable platform using ultrasonic waves, and the like.
  • the first direction is the downward direction of the movable platform
  • the second direction is the front and rear directions of the movable platform as an example.
  • the first direction and the second direction may be other situations.
  • the first direction may include any direction in the vertical direction of the movable platform
  • the second direction may include the movable platform. any direction in the horizontal direction.
  • the first direction and the second direction may form any angle with the horizontal or vertical direction of the movable platform.
  • the included angle may be 0 degrees, 10 degrees, 20 degrees, 30 degrees, 40 degrees, 50 degrees, 60 degrees, 70 degrees, 80 degrees, or 90 degrees.
  • the first direction is the downward direction
  • the second direction is the forward direction and the rearward direction, so as to facilitate the unmanned aerial vehicle to perform flight tasks, return home and land.
  • the first direction is the downward direction
  • the second direction is the front direction and the rear direction, so that the unmanned vehicle or robot can perform tasks, return home and avoid movement obstruction.
  • Controlling the gimbal to enter the corresponding gimbal mode according to the current movement mode of the drone may include: when the current movement mode of the drone is the first movement mode, determining that the gimbal enters the stabilization mode. And after the confirmation, you can control the gimbal to enter the stabilization mode.
  • the first movement mode may be a P gear or a normal gear. Since, in the first motion mode, the use state of the detection device makes the movable platform have a relatively slow moving speed, the control of the motion parameters of the movable platform is less affected by the user's instructions (the motion parameters of the movable platform are affected by the user's instructions). The positioning device and the detection device are partially affected), the use state of the positioning device and the detection device enables the movable platform to achieve precise hovering (when the movable platform is an aircraft) and stable movement.
  • the first-person perspective experience is convenient for the movable platform to shoot stable images (when the movable platform is an aircraft, it is convenient for aerial photography) and to collect stable sounds. Therefore, control the gimbal to enter the stabilization mode.
  • the plurality of motion modes may include a second motion mode
  • FIG. 5 is a schematic diagram of the movable platform according to an embodiment of the present application when the movable platform is in the second motion mode.
  • the use state of the positioning device 400 is turned on, and the use state of the detection device 500 is to turn on the surrounding obstacle information for the movable platform 10 in the first direction
  • the function of visual obstacle avoidance is disabled, and the surrounding obstacle information is used for the visual obstacle avoidance function of the movable platform 10 in the second direction.
  • the function of disabling the surrounding obstacle information for visual obstacle avoidance of the movable platform 10 in the second direction may include: not detecting the surrounding obstacle information of the movable platform 10 in the second direction, or detecting the movable platform 10 surrounding obstacle information in the second direction, but the detected information is not used for visual obstacle avoidance of the movable platform 10 in the second direction.
  • the movable platform when it is in the second motion mode, it may have a larger horizontal movement speed than when it is in the first motion mode, whereby the second motion mode is more efficient than the first motion mode Suitable for some users who have experience with mobile platforms.
  • the specific speed can be selected according to the actual situation.
  • its horizontal movement speed when the movable platform is in the second motion mode, its horizontal movement speed can be 17m/s to 23m/s, for example, it can be 17m/s, 17.5m/s, 18m /s, 18.5m/s, 19m/s, 19.5m/s, 20m/s, 20.5m/s, 21m/s, 21.5m/s, 22m/s, 22.5m/s, 23m/s, etc.
  • its horizontal movement speed may be 12m/s to 16m/s, for example, it may be 12m/s, 12.5m/s, 13m/s, 13.5m/s, 14m/s , 14.5m/s, 15m/s, 15.5m/s, 16m/s, etc.
  • the maximum ascending speed and the maximum descending speed of the movable platform can be selected according to the actual situation, for example, the maximum ascending speed can be 12m/s to 16m/ s, for example, may be 12m/s, 12.5m/s, 13m/s, 13.5m/s, 14m/s, 14.5m/s, 15m/s, 15.5m/s, 16m/s, and the like.
  • the maximum descending speed can be 8m/s to 12m/s, for example, it can be 8m/s, 8.5m/s, 9m/s, 9.5m/s, 10m/s, 10.5m/s, 11m/s, 11.5m /s, 12m/s, etc.
  • Controlling the gimbal to enter the corresponding gimbal mode according to the current movement mode of the drone may include: when the current movement mode of the drone is the second movement mode, controlling the gimbal to enter the stabilization mode. And after the confirmation, you can control the gimbal to enter the stabilization mode.
  • the second movement mode may be the S gear or the movement mode. Since, in the second motion mode, the use state of the detection device causes the movable platform to have a relatively slow moving speed, the control of the motion parameters of the movable platform is less affected by the user's instructions (the motion parameters of the movable platform are affected by the user's instructions). The positioning device and the detection device are partially affected), the use status of the positioning device and the detection device enables the movable platform to hover (when the movable platform is an aircraft) and move stably. At this time, it is not convenient for users to experience the first step of the movable platform. The one-person perspective experience is convenient for the movable platform to shoot stable images (when the movable platform is an aircraft, it is convenient for aerial photography) and to collect stable sounds. Therefore, control the gimbal to enter the stabilization mode.
  • the plurality of motion modes may include a third motion mode
  • FIG. 6 is a schematic diagram of the movable platform according to an embodiment of the present application when the movable platform is in the third motion mode.
  • the use state of the positioning device is to close the function of position information for controlling the position of the movable platform
  • the use state of the detection device is to close the surrounding obstacle information for use in The visual obstacle avoidance function of the movable platform in the first direction and the second direction.
  • the use state of the positioning device is that the function of the position information used to control the position of the movable platform may include: the positioning device is not used to obtain the position information of the movable platform, or the positioning device is used to obtain the position information of the movable platform, but the position The information is not used to control the position of the movable platform.
  • the function of disabling the surrounding obstacle information for visual obstacle avoidance of the movable platform 10 in the first direction may include: not detecting the surrounding obstacle information of the movable platform 10 in the first direction, or detecting the movable platform 10 surrounding obstacle information in the first direction, but the detected information is not used for visual obstacle avoidance of the movable platform 10 in the first direction.
  • Controlling the gimbal to enter the corresponding gimbal mode according to the current movement mode of the drone may include: when the current movement mode of the drone is the third movement mode, controlling the gimbal to enter the follow mode. And after the confirmation, you can control the gimbal to enter the stabilization mode.
  • the third movement mode may be the A gear or the attitude gear. Because, in the third motion mode, the use state of the detection device makes the movable platform have a relatively fast moving speed, and the control of the motion parameters of the movable platform is greatly affected by the user's instructions (the motion parameters of the movable platform are not Influenced by the positioning device and the detection device), the use state of the positioning device and the detection device makes it difficult for the movable platform to hover (when the movable platform is an aircraft) and move stably. At this time, it is convenient for users to experience the first step of the movable platform. The one-person perspective experience is not convenient for the movable platform to shoot stable images (when the movable platform is an aircraft, it is not convenient for aerial photography) and to collect stable sounds. Therefore, control the gimbal to enter the follow mode.
  • the movable platform when the positioning device cannot detect the position of the movable platform, and the detection device cannot detect the surrounding obstacle information of the movable platform, the movable platform is controlled to be in the third motion mode.
  • control method provided by this embodiment may further include: judging the reason why the movable platform is in the third motion mode; when the result of the judgment indicates that the reason why the movable platform is in the third motion mode is in response to When the user inputs an instruction, the step of controlling the PTZ to enter the follow mode is triggered.
  • FIG. 7 is a schematic diagram of a movable platform in a third motion mode in response to user input instructions, according to one embodiment of the present application.
  • Fig. 7 takes the movable platform in the first movement mode before being in the third movement mode as an example. It can be understood that before the movable platform is in the third movement mode, the movable platform can also be in other movement modes, for example, the second movement mode. Sports mode or the fourth sports mode mentioned later, etc. Among them, the user can input instructions in various ways, for example, through a remote control of a movable platform, a smart terminal, and the like.
  • the third motion mode is inconvenient for the movable platform to capture stable images (When the movable platform is an aircraft, it is inconvenient for aerial photography) and stable sound collection is convenient for users to experience the movement of the movable platform in the first-person perspective.
  • the steps of triggering and controlling the gimbal to enter the follow mode can meet the user's expectations.
  • the movable platform when the movable platform is automatically switched from the first motion mode to the third motion mode, keep the gimbal in the stabilization mode, and when the movable platform is automatically switched from the second motion mode to the third motion mode, keep the gimbal in the stabilization mode mode, when the movable platform is automatically switched from the fourth movement mode mentioned later to the third movement mode, the gimbal is maintained in the follow mode. At this time, the mode in which the PTZ is located is more in line with the user's expectation.
  • the triggering condition for the movable platform to automatically switch from the previous motion mode to the third motion mode may include a decrease in reliability of detection information of the global positioning system and the visual positioning system.
  • the reliability of determining the detection information of the GPS is reduced when the signal of the GPS is below a preset signal threshold. In other embodiments, the reliability of determining the detection information of the GPS may be reduced when the compass of the GPS is disturbed. When the illumination around the movable platform is lower than the preset brightness threshold, the reliability of determining the detection information of the visual positioning system is reduced.
  • the preset signal threshold can be set such that when the signal of the GPS is lower than the preset signal threshold, the GPS cannot obtain the position information of the movable platform
  • the preset brightness threshold can be set such that when the movable platform is When the surrounding light is lower than the preset brightness threshold, the visual positioning system cannot obtain the surrounding obstacle information of the movable platform.
  • the plurality of motion modes include a fourth motion mode.
  • FIG. 8 is a schematic diagram of the movable platform when the movable platform is in the fourth motion mode according to an embodiment of the present application.
  • the use of the positioning device The state is on, and the use state of the detection device is to turn off the function of the surrounding obstacle information for visual obstacle avoidance of the movable platform in the first direction and the second direction.
  • its horizontal movement speed may be 25m/s to 30m/s, for example, it may be 25m/s, 25.5m/s, 26m/s, 26.5m/s, 27m/s , 27.5m/s, 28m/s, 28.5m/s, 29m/s, 29.5m/s, 30m/s, etc.
  • Controlling the gimbal to enter the corresponding gimbal mode according to the current movement mode of the drone may include: when the current movement mode of the drone is the fourth movement mode, controlling the gimbal to enter the follow mode. And after confirmation, you can control the gimbal to enter the follow mode.
  • the fourth movement mode may be the M gear or the manual gear. Because, in the fourth motion mode, the use state of the detection device makes the movable platform have a relatively fast moving speed, and the control of the motion parameters of the movable platform is greatly affected by the user's instructions (the motion parameters of the movable platform are affected by the user's instructions). The influence of the positioning device and the detection device is small), the use state of the detection device makes it difficult for the movable platform to achieve precise hovering (when the movable platform is an aircraft) and stable movement. At this time, it is convenient for the user to experience the first-person perspective of the movable platform. Experience, it is not convenient for the movable platform to take stable images (when the movable platform is an aircraft, it is not convenient for aerial photography) and to collect stable sounds, therefore, control the gimbal to enter the follow mode.
  • the relevant design of the motion modes may vary.
  • the number of motion modes of the movable platform may be other than 4, for example, it may be 2 , 3 types, 5 types, 6 types, 7 types, 8 types, 9 types, 10 types, etc., and, when the number of motion modes is 4, the use status of the positioning device and/or the detection device in each motion mode is also The usage state may be provided without being limited to the above-described embodiment.
  • the corresponding relationship between the various motion modes, the stabilization mode, and the following mode may also be changed, and may not be limited to the corresponding relationship provided in the foregoing embodiment.
  • the control method for the movable platform provided by the present application may further include: when the movable platform performs a motion operation according to a preset control instruction, controlling the pan/tilt head to be in a stabilization mode. Therefore, when the movable platform is performing these motion operations and the load is an imaging device, the imaging can be stably formed. When the movable platform is performing these motion operations and the load is a microphone, the surrounding sound can be collected stably, so that the pan/tilt head can be stably collected. The mode is more suitable for these motion operations.
  • the step of triggering and detecting the motion mode the movable platform is currently in is stopped during the process that the movable platform performs the motion operation according to the preset control instruction. Therefore, the movable platform has an adapted pan/tilt mode during the entire process of performing these motion operations.
  • the preset control command may include a return-to-home command or a landing command, thereby facilitating the user to grasp the information related to the movable platform when returning to home or landing to avoid accidents such as collisions.
  • the payload is an imaging device
  • stable images related to returning to flight or landing can be provided, and the user can operate the aircraft according to these images, thereby avoiding accidents and improving user experience.
  • the preset control command may include a return-to-home command, thereby facilitating the user to grasp the information related to the movable platform when returning to the home, and to avoid accidents such as collisions.
  • the payload is an imaging device, it can provide stable images related to returning home, and the user can operate the movable platform according to these images, thereby avoiding accidents and improving user experience.
  • the return-to-home command or the landing command can be issued by the user, or can be obtained by the movable platform itself.
  • the return-to-home command or the landing command can be obtained by itself.
  • the control method provided by the embodiment of the present application may further include: when the movable platform is powered on, controlling the PTZ to enter a follow mode.
  • the gimbal can be provided with a limit structure that limits its rotation angle, because the movable platform is placed in various positions when it is turned on. For example, it can be reversed from the normal use state.
  • the gimbal enters the stabilization mode, there may be a risk of hitting the limit, which may cause damage to the limit structure. Therefore, when the gimbal is turned on, control the gimbal to enter the follow mode.
  • the step of triggering and detecting the motion mode that the movable platform is currently in is stopped during the period from when the movable platform is powered on to when the set condition is satisfied. That is to say, from the time when the movable platform is turned on to when the set conditions are met, the gimbal is in the following mode, so as to avoid the risk of hitting the limit during this period.
  • the setting conditions can include that the time after the mobile platform is turned on reaches the time threshold, and the mobile platform is turned on, indicating that the user expects to operate the mobile platform after a period of time. Therefore, the position of the mobile platform will be adjusted to normal after a period of time. Where to use the state. Therefore, the set condition may include that the time period after the movable platform is powered on reaches the time period threshold.
  • the duration threshold may be determined according to the actual situation, for example, may be 1s, 2s, 3s, 4s, 5s, 6s, 7s, 9s, 10s, 20s, 30s, 40s, 50s, 60s, etc.
  • the setting conditions can include that the movable platform obtains the selection instruction of the motion mode, and the acquisition of the selection instruction of the motion mode indicates that the user can operate the movement of the movable platform, and the user needs to adjust the position of the movable platform to normal when operating the movable platform.
  • the setting condition may include the movable platform acquiring the motion mode selection instruction.
  • the setting condition may also include that the height of the movable platform is at the height threshold. At this time, it means that the movable platform is already in the flying state. Trigger the step of detecting the motion mode that the movable platform is currently in, so that the control method of the gimbal on the load attitude can be adapted to the motion mode that the movable platform is currently in, so that the movable platform is currently in a different motion mode. Under the circumstance, the control method of the gimbal to the load attitude can meet the needs of different motion modes.
  • the method may further include: controlling the measured attitude of the load to the ground in the stabilization mode to be the target corresponding to the target relative attitude angle of the load and the support mechanism in the follow mode Ground stance.
  • FIG. 9 is a schematic diagram when the gimbal of the movable platform enters the stabilization mode from the follow mode according to an embodiment of the present application. It can be understood that the state shown in FIG. 9 is the moment when the gimbal enters the stabilization mode from the follow mode. At this time, the target relative attitude angle of the load 100 and the support mechanism 300 can be the angle ⁇ shown in FIG. 9 , which corresponds to the angle ⁇ .
  • the target ground attitude can be represented by the angle ⁇ , then when the gimbal enters the stabilization mode from the follow mode, the target ground attitude represented by the angle ⁇ is directly assigned to the measured ground attitude of the load 100 in the stabilization mode, that is At this time, the measurement of the attitude to the ground is directly assigned, not obtained by measurement. Therefore, at this moment, the position of the gimbal is relatively stable and does not vibrate.
  • the load 100 is an imaging device
  • the imaging device can take pictures. The picture is stable, no twitching occurs, and the torque of the gimbal's motor will not change abruptly.
  • the above-mentioned direct assignment of the measured ground attitude can only be performed at the moment when the gimbal enters the stabilization mode from the follow mode, and then the measured ground attitude can be obtained by real-time measurement, and the user can also adjust the stabilization as needed.
  • the target ground attitude of the mode can only be performed at the moment when the gimbal enters the stabilization mode from the follow mode, and then the measured ground attitude can be obtained by real-time measurement, and the user can also adjust the stabilization as needed.
  • the target ground attitude of the mode can be understood that the above-mentioned direct assignment of the measured ground attitude can only be performed at the moment when the gimbal enters the stabilization mode from the follow mode, and then the measured ground attitude can be obtained by real-time measurement, and the user can also adjust the stabilization as needed.
  • the target ground attitude of the mode can only be performed at the moment when the gimbal enters the stabilization mode from the follow mode, and then the measured ground attitude can be obtained by real-time measurement, and the user
  • the gimbal when the gimbal enters the following mode from the stabilization mode, it may further include: controlling the measured relative attitude angle of the load and the support mechanism in the following mode to be the target corresponding to the ground attitude of the load in the stabilization mode Relative attitude angle.
  • FIG. 10 is a schematic diagram when the gimbal of the movable platform enters the follow mode from the stabilization mode according to an embodiment of the present application.
  • the state shown in Figure 10 is the moment when the gimbal enters the follow mode from the stabilization mode.
  • the target attitude of the load to the ground can be represented by the angle ⁇ in Figure 10
  • the relative attitude angle of the target corresponding to the angle ⁇ is angle ⁇
  • the angle ⁇ is directly assigned to the measured relative attitude angle of the load 100 in the follow mode, that is, the measured relative attitude angle is directly assigned, not measured. Therefore, at this moment, the position of the gimbal is relatively stable and will not shake.
  • the load 100 is an imaging device
  • the image taken by the imaging device can be stabilized without twitching, and the torque of the motor of the gimbal can be stabilized. Mutation does not occur.
  • the above-mentioned direct assignment of the measured relative attitude angle can only be performed at the moment when the gimbal enters the follow mode from the stabilization mode, and then the measured relative attitude angle can be obtained by real-time measurement, and the user can also adjust the follow mode as required.
  • the target relative attitude angle of that is, even when the movable platform moves, the user can adjust the target relative attitude angle according to the needs to meet the user's expectations.
  • FIG. 11 is a control principle diagram when the gimbal of the movable platform is in the stabilization mode according to an embodiment of the present application.
  • the control method may further include: determining the ground target attitude angle Ra of the load; obtaining the ground measurement attitude angle ya of the load; according to the ground target attitude angle Ra and the ground measurement
  • the attitude angle ya controls the gimbal to keep the load-to-ground attitude stable.
  • the ground measurement attitude angle ya can be obtained by measuring units, such as inertial measurement units, electronic accelerometers and gyroscopes, etc., and can also be obtained by fusion attitude estimator FUS through attitude fusion.
  • Controlling the gimbal according to the ground target attitude angle Ra and the ground measurement attitude angle ya to keep the load’s ground attitude stable may include: determining the load’s ground target angular velocity according to the ground target attitude angle Ra and the ground measurement attitude angle ya; Get the ground-measured angular velocity of the load According to the angular velocity of the ground target and the measured angular velocity of the ground Determine the control torque u of the motor of the gimbal; control the motor of the gimbal 200 according to the control torque u, so as to keep the attitude of the load to the ground stable.
  • Measuring angular velocity over the ground It can be obtained by measuring units, such as inertial measurement units, electronic accelerometers and gyroscopes, etc., and can also be obtained by fusion attitude estimator FUS through attitude fusion.
  • determining the ground target angular velocity of the load according to the ground target attitude angle Ra and the ground measurement attitude angle ya may include: determining the error e according to the ground target attitude angle Ra and the ground measurement attitude angle ya (at this time, representing the load Attitude error), and then determine the ground target angular velocity of the load through the attitude angle loop controller C1.
  • Determining the control torque of the motor of the gimbal may include: acquiring the external disturbance d received by the gimbal, and the external disturbance d can cause the position and/or attitude of the gimbal to change; according to the target angular velocity to the ground, the angular velocity measured to the ground And the external disturbance d (disturbance torque) determines the control torque u.
  • the ground measurement angular velocity And the attitude angular velocity loop controller C2 obtains the to-be-corrected torque, and determines the control torque u according to the to-be-corrected torque and the external disturbance d.
  • the external disturbance d may be determined based on one or more motion characteristics of the pan/tilt head connected to the load.
  • the external disturbance d can be associated with disturbance to the gimbal.
  • disturbances may include one or more of wind effects, temperature changes, or external impacts to the load or head.
  • the motion characteristics of the gimbal may include the instantaneous attitude, instantaneous position, linear velocity, angular velocity, linear acceleration and/or angular acceleration of the gimbal.
  • the external disturbance d can be calculated with respect to a rotatable joint on the frame of the head (eg, the heading frame), which is configured to connect the frame with the support mechanism.
  • Sensor data that can be obtained from the external disturbance sensor to obtain the amount of external disturbance d.
  • sensor data is input into a dynamic model of the gimbal and/or load, and the output of the model is the external disturbance d.
  • the kinetic model may include parameters corresponding to specific characteristics of a specific head and/or load. Determination of model parameters and generation of kinetic models can be determined according to methods known to those skilled in the art. The kinetic model may be determined prior to operation and may be pre-stored in memory located on the load, head and/or movable object.
  • the mathematical model for the relationship between the external disturbance d on the outer frame (eg, the heading frame) and the acceleration of the shock-absorbing element connecting the gimbal to the support mechanism is:
  • Tdisturb (K1sin( ⁇ )
  • Tdisturb is the external disturbance d on the drive of the outer frame (e.g. the heading drive); K1, K2, K3 and K4 are the parameters of the dynamics model, based on the weights, rotational inertia tensors and geometry of the three gimbal frames to determine these parameters; where ax and ay are the accelerations of the damping element in the x (a direction perpendicular to the vertical direction) and the y direction (the other direction perpendicular to the vertical direction and perpendicular to the x direction), respectively measurement results; and ⁇ , ⁇ is the current joint angle measured by a sensor (such as a potentiometer) connected to the drive of the gimbal frame (e.g., ⁇ is the angle of the heading drive of the yaw frame, and ⁇ is the roll of the roll frame angle of the drive).
  • a sensor such as a potentiometer
  • the role of the stabilization mode is to design the attitude angle loop controller C1 and the attitude angular velocity loop controller C2, so that under the action of the external disturbance d, the ground measurement attitude angle ya is as close as possible to the ground target attitude angle Ra, and the error e is It should be as small as possible to ensure the stable attitude of the load to the ground.
  • FIG. 12 is a control principle diagram of the gimbal of the movable platform when it is in a follow mode according to an embodiment of the present application.
  • the control method further includes: determining the target relative attitude angle Rj of the load and the support mechanism; obtaining the measured relative attitude angle yj of the load and the support mechanism; according to the target relative attitude angle Rj and the measured relative attitude angle Rj The attitude angle yj controls the gimbal to keep the relative attitude of the load and the support mechanism stable.
  • Controlling the gimbal according to the target relative attitude angle Rj and the measured relative attitude angle yj to keep the relative attitude of the load and the support mechanism stable may include: determining the target relative attitude between the load and the support mechanism according to the target relative attitude angle Rj and the measured relative attitude angle yj Attitude angular velocity; obtains the measured relative attitude angular velocity between the load and the support mechanism According to the target relative attitude angular velocity and the measured relative attitude angular velocity Determine the control torque u of the motor of the gimbal 200; control the motor according to the control torque u to keep the relative posture of the load and the support mechanism stable.
  • Determining the target relative attitude angular velocity between the load and the support mechanism according to the target relative attitude angle Rj and the measured relative attitude angle yj may include: determining the error e (in this case, the joint angle error) according to the target relative attitude angle Rj and the measured relative attitude angle yj , and then determine the target relative attitude angular velocity through the joint angle loop controller C3.
  • Determining the control torque of the motor of the gimbal may include: acquiring the external disturbance d received by the gimbal, the external disturbance d can cause the position and/or attitude of the gimbal to change; according to the target relative attitude angular velocity, measure the relative attitude angular velocity And the external disturbance d determines the control torque u.
  • the ground measurement angular velocity And the joint angular velocity loop controller C4 obtains the torque to be corrected, and determines the control torque u according to the torque to be corrected and the external disturbance d.
  • the role of the follow mode is to design the joint angle loop controller C3 and the joint angular velocity loop controller C4, so that under the action of the external disturbance d, the measured relative attitude angle yj is as close to the target relative attitude angle Rj as possible,
  • the error e is as small as possible to ensure that the relative angle between the gimbal and the support mechanism remains unchanged, and the gimbal closely follows the attitude of the support mechanism to adjust the attitude.
  • the target relative attitude angle Rj does not need to be measured in real time, so that less physical quantities need to be measured, and only the relative attitude angular velocity needs to be measured Therefore, the error caused by the measurement accuracy can be reduced, and the movable platform does not need to activate more sensors, which improves the user experience.
  • FIG. 13 is a control principle diagram when the pan/tilt of the movable platform is in a follow mode according to another embodiment of the present application.
  • the control method further includes: determining the ground target attitude angle Rfc of the load; obtaining the ground measurement attitude angle ya of the load; according to the ground target attitude angle Rfc and the ground measurement of the load
  • the attitude angle ya controls the gimbal to keep the relative attitude of the load and the support mechanism stable.
  • the ground target attitude angle Rfc of the load can be determined by the ground measurement attitude angle of the support mechanism.
  • the ground measurement attitude angle ya can be obtained by measuring units, such as inertial measurement units, electronic accelerometers and gyroscopes, etc., and can also be obtained by fusion attitude estimator FUS through attitude fusion.
  • Control the gimbal according to the ground target attitude angle Rfc and the load’s ground measurement attitude angle ya to keep the relative attitude of the load and the support mechanism stable including: determining according to the ground target attitude angle Rfc and the load’s ground measurement attitude angle ya
  • the ground target angular velocity of the load obtain the measured ground angular velocity of the load
  • the control torque u of the motor of the gimbal control the motor according to the control torque u to keep the relative posture of the load and the support mechanism stable.
  • Measuring angular velocity over the ground It can be obtained by measuring units, such as inertial measurement units, electronic accelerometers and gyroscopes, etc., and can also be obtained by fusion attitude estimator FUS through attitude fusion.
  • Determining the ground target angular velocity of the load according to the ground target attitude angle Rfc and the load’s ground measurement attitude angle ya may include: determining the error e according to the ground target attitude angle Rfc and the load’s ground measurement attitude angle ya (in this case, it is Attitude error), and then determine the ground target angular velocity of the load through the attitude angle loop controller C1.
  • Determining the control torque of the motor of the gimbal may include: acquiring the external disturbance d received by the gimbal, and the external disturbance d can cause the position and/or attitude of the gimbal to change; according to the target angular velocity to the ground, the angular velocity measured to the ground And the external disturbance d determines the control torque u.
  • the ground measurement angular velocity And the attitude angular velocity loop controller C2 obtains the torque to be corrected, and determines the control torque u according to the torque to be corrected and the external disturbance d.
  • the role of the following mode is to design the attitude angle loop controller C1 and the attitude angular velocity loop controller C2, so that under the action of the external disturbance d, the target attitude angle Rfc to the ground is as close as possible to the ground measurement attitude angle.
  • the error e is as small as possible to ensure that the relative angle between the gimbal and the support mechanism remains unchanged, and the gimbal closely follows the attitude of the support mechanism to adjust the attitude.
  • the above-mentioned stabilization mode and following mode are implemented by a PID (Proportion Integration Differentiation, proportional integral derivative) algorithm, thereby ensuring the control accuracy and response speed. That is to say, in the stabilization mode, the gimbal has strong stabilization performance, that is, the control accuracy during stabilization is high. At the same time, in the follow mode, the gimbal closely follows the adjustment of the support mechanism.
  • PID Proportion Integration Differentiation, proportional integral derivative
  • the PID control framework is similar to the stabilization mode, except that the target-to-ground attitude of the stabilization mode is not measured in real time, while the target-to-ground attitude of the following mode shown in Figure 13 is not measured in real time.
  • the attitude is the measured ground attitude of the support mechanism measured in real time. Therefore, when designing the PID in the following mode shown in FIG. 13 , only a few adjustments need to be made to the control framework of the PID in the stabilization mode, which reduces the production labor cost of the movable platform.
  • the movable platform When the movable platform is powered on, for example, when powered on according to the power-on command issued by the user, the gimbal will enter the follow mode. Then, the movable platform acquires the motion mode selection instruction, and triggers the step of detecting the motion mode currently in which the movable platform is located.
  • the selection instruction may indicate that the user expects the movable platform to be in the first motion mode, then the movable platform is controlled to be in the first motion mode, and the gimbal is placed in the stabilization mode.
  • the user can also issue a selection instruction, and the selection instruction issued this time can indicate that the user expects the movable platform to be in the second motion mode, then controls the movable platform to be in the second motion mode, and makes the gimbal in the stabilization mode.
  • the user can issue a selection instruction again, and the reissued selection instruction can indicate that the user expects the movable platform to be in the third motion mode, and then controls the movable platform to be in the third motion mode.
  • the reason why the movable platform is in the third motion mode is In response to the user's input instruction, the step of controlling the PTZ to enter the follow mode is triggered.
  • the measured ground attitude of the load in the control stabilization mode is the target ground attitude corresponding to the target relative attitude angle of the load and the support mechanism in the follow mode.
  • the user can issue the selection instruction again, and the selection instruction issued again can indicate that the user expects the movable platform to be in the fourth motion mode, then controls the movable platform to be in the fourth motion mode, and makes the pan/tilt head in the follow mode.
  • the movable platform continues to move.
  • the movable platform will automatically switch from the fourth motion mode to the third motion mode. At this time, keep the gimbal in the first motion mode.
  • the gimbal is controlled to be in stabilization mode.
  • the measured ground attitude of the load in the control stabilization mode is the target ground attitude corresponding to the target relative attitude angle of the load and the support mechanism in the follow mode.
  • the step of triggering and detecting the motion mode that the movable platform is currently in is stopped.
  • the movable platform is an aircraft, the movable platform will also land according to the landing command.
  • the gimbal is controlled to be in the stabilization mode, and the step of triggering the detection of the current motion mode of the movable platform is stopped during the landing process. until the movable platform has landed.
  • This embodiment also provides a computer-readable storage medium, where the computer-readable storage medium stores executable instructions, and when executed by one or more processors, the executable instructions can cause one or more processors to execute any of the above A control method of a movable platform.
  • the computer-readable storage medium may also be referred to as a memory, and the executable instructions may also be referred to as a program.
  • the processor may perform various appropriate actions and processes according to programs stored in read only memory (ROM) or loaded into random access memory (RAM).
  • a processor may include, for example, a general-purpose microprocessor (eg, a CPU), an instruction set processor and/or a related chipset, and/or a special-purpose microprocessor (eg, an application specific integrated circuit (ASIC)), among others.
  • the processor may also include onboard memory for caching purposes.
  • the processor may comprise a single processing unit or multiple processing units for performing different actions of the method flow according to this embodiment.
  • the processor, ROM, and RAM are connected to each other through a bus.
  • the processor performs various operations of the method flow according to the present embodiment by executing programs in the ROM and/or RAM. Note that programs may also be stored in one or more memories other than ROM and RAM.
  • the processor may also perform various operations of the method flow according to the present embodiment by executing programs stored in one or more memories.
  • the apparatus to which the computer-readable storage medium is applied may further include an input/output (I/O) interface, which is also connected to the bus.
  • the device employing the computer-readable storage medium may also include one or more of the following components connected to the I/O interface: an input portion including a keyboard, a mouse, etc.; an input portion such as a cathode ray tube (CRT), a liquid crystal display (LCD) ), etc., and an output section for speakers, etc.; a storage section including a hard disk, etc.; and a communication section including a network interface card such as a LAN card, a modem, and the like.
  • the communication section performs communication processing via a network such as the Internet.
  • Removable media such as magnetic disks, optical disks, magneto-optical disks, semiconductor memories, etc., are mounted on the drive as needed, so that the computer program read therefrom is installed into the storage section as needed.
  • the method flow according to this embodiment can be implemented as a computer software program.
  • the present embodiment includes a computer program product comprising a computer program carried on a computer-readable storage medium, the computer program containing program code for performing the method shown in the flowchart.
  • the computer program may be downloaded and installed from a network via the communication portion, and/or installed from a removable medium.
  • the above-described functions defined in the system of the present embodiment are executed.
  • computer readable storage media may include, but are not limited to, non-volatile or volatile storage media such as random access memory (RAM), static RAM, dynamic RAM, read only memory (ROM), programmable ROM , Erasable Programmable ROM, Electrically Erasable Programmable ROM, Flash Memory, Secure Digital (SD) Card, etc.
  • RAM random access memory
  • ROM read only memory
  • programmable ROM Erasable Programmable ROM
  • Flash Memory Flash Memory
  • SD Secure Digital
  • This embodiment also provides a control device for a movable platform, where the movable platform includes a pan-tilt for carrying loads and a support mechanism for supporting the pan-tilt.
  • the control device includes a memory and a processor.
  • the memory is used to store the executable instructions
  • the processor is used to execute the executable instructions stored in the memory, so as to perform the following operations: obtain the current motion mode of the movable platform, wherein the movable platform has multiple motion modes, and different motion modes
  • the control methods of the movable platforms are different; according to the current motion mode of the movable platform, it is determined that the gimbal enters the corresponding gimbal mode.
  • follow mode used to keep the relative attitude of the load and support mechanism stable.
  • control device may be located on the movable platform, or may be independent of the movable platform and be communicatively connected with the movable platform.
  • the movable platform may also include a positioning device and a detection device, the positioning device is used to obtain the position information of the movable platform, and the detection device is used to detect the surrounding obstacle information of the movable platform; in different motion modes, the positioning device and/or the detection device The usage status of the mobile platform is different, so that the movable platform has different control methods.
  • the plurality of motion modes may include a first motion mode.
  • the use state of the positioning device is turned on, and the use state of the detection device is to turn on the surrounding obstacle information for the movable platform in the first motion mode.
  • the processor may further perform the following operation: when the current motion mode of the movable platform is the first motion mode, determine that the pan/tilt head enters the stabilization mode.
  • the plurality of motion modes include a second motion mode.
  • the use state of the positioning device is turned on, and the use state of the detection device is to turn on the surrounding obstacle information for the movable platform in the first party.
  • the function of upward visual obstacle avoidance is turned off, and the surrounding obstacle information is used for the visual obstacle avoidance function of the movable platform in the second direction.
  • the processor also performs the following operation: when the current motion mode of the movable platform is the second motion mode, it is determined that the pan-tilt head enters the stabilization mode.
  • the plurality of motion modes include a third motion mode.
  • the use state of the positioning device is to close the function of the position information for controlling the position of the movable platform, and the use state of the detection device is to close the surrounding
  • the obstacle information is used for the visual obstacle avoidance function of the movable platform in the first direction and the second direction.
  • the processor also performs the following operation: when the current motion mode of the movable platform is the third motion mode, it is determined that the pan-tilt head enters the follow mode.
  • the processor may also perform the following operations: determine the reason why the movable platform is in the third motion mode; when the result of the judgment indicates that the reason why the movable platform is in the third motion mode is in response to the user When the input command is entered, the step of determining that the gimbal enters the follow mode is triggered.
  • the processor may also perform the following operations: when the result of the judgment indicates that the movable platform is in the third movement mode because the movable platform is automatically switched from the last movement mode to the third movement mode, determine that the gimbal remains in the last movement mode Corresponding stabilization mode or follow mode.
  • the positioning means may comprise a global positioning system, and the detection means may comprise a visual positioning system.
  • the triggering condition for the movable platform to automatically switch from the previous motion mode to the third motion mode may include a decrease in reliability of detection information of the global positioning system and the visual positioning system.
  • the processor may further perform the following operation: when the signal of the global positioning system is lower than a preset signal threshold, the reliability of determining the detection information of the global positioning system is reduced.
  • the processor may further perform the following operation: when the illumination around the movable platform is lower than the preset brightness threshold, the reliability of determining the detection information of the visual positioning system is reduced.
  • the plurality of motion modes include a fourth motion mode.
  • the use state of the positioning device is turned on, and the use state of the detection device is to turn off the surrounding obstacle information for the movable platform to operate in the fourth motion mode.
  • the processor may also perform the following operation: when the current motion mode of the movable platform is the fourth motion mode, control the pan/tilt to enter the follow mode.
  • the first direction may include a vertical direction
  • the second direction may include a horizontal direction
  • the processor may also perform the following operation: when the movable platform performs a motion operation according to the preset control instruction, control the pan/tilt to be in a stabilization mode.
  • the processor may further perform the following operation: stop triggering the step of acquiring the current motion mode of the movable platform during the process of the movable platform performing the motion operation according to the preset control instruction.
  • the movable platform may include an aircraft, and the preset control command may include a return home command or a landing command.
  • the processor can also perform the following operations: when the movable platform is powered on, it controls the PTZ to enter the follow mode.
  • the processor may further perform the following operation: stop triggering the step of detecting the motion mode currently in which the movable platform is located during the period from when the movable platform is powered on to when the set condition is satisfied.
  • the setting conditions may include: the time period after the movable platform is powered on reaches a time period threshold; or the movable platform obtains an instruction for selecting a motion mode.
  • the processor can also perform the following operations: control the measured ground attitude of the load in the stabilization mode to be the target ground attitude corresponding to the target relative attitude angle of the load and the support mechanism in the follow mode .
  • the processor can also perform the following operations: control the measured relative attitude angle of the load and the support mechanism in the follow mode to the target relative attitude angle corresponding to the target ground attitude of the load in the stabilization mode .
  • the processor can also perform the following operations: determine the target relative attitude angle between the load and the support mechanism; obtain the measured relative attitude angle between the load and the support mechanism; control the gimbal according to the target relative attitude angle and the measured relative attitude angle , to keep the relative posture of the load and the support mechanism stable.
  • the processor may also perform the following operations: determine the target relative attitude angular velocity between the load and the support mechanism according to the target relative attitude angle and the measured relative attitude angle; obtain the measured relative attitude angular velocity between the load and the support mechanism; according to the target relative attitude angular velocity and the measured relative attitude angular velocity; The attitude angular velocity determines the control torque of the motor of the gimbal; the motor is controlled according to the control torque to keep the relative attitude of the load and the support mechanism stable.
  • the processor may also perform the following operations: acquire external disturbances to the gimbal, which can change the position and/or attitude of the gimbal; determine the control torque according to the target relative attitude angular velocity, the measured relative attitude angular velocity, and the external disturbance.
  • the processor can also perform the following operations: determine the ground target attitude angle of the load; obtain the ground measurement attitude angle of the load; control the gimbal according to the ground target attitude angle and the load ground measurement attitude angle , to keep the relative posture of the load and the support mechanism stable.
  • the ground target attitude angle of the load can be determined by the ground measurement attitude angle of the support mechanism.
  • the processor may also perform the following operations: determine the ground target angular velocity of the load according to the ground target attitude angle and the ground measurement attitude angle of the load; obtain the ground measurement angular velocity of the load; determine the cloud according to the ground target angular velocity and the ground measurement angular velocity Control torque of the motor of the platform; control the motor according to the control torque to keep the relative posture of the load and the support mechanism stable.
  • the processor may also perform the following operations: acquire external disturbances to the gimbal, which can change the position and/or attitude of the gimbal; determine the control torque according to the target angular velocity on the ground, the measured angular velocity on the ground, and the external disturbance.
  • This embodiment also provides a movable platform, and the movable platform includes a pan-tilt for carrying loads and a support mechanism for supporting the pan-tilt.
  • the removable platform also includes memory and a processor.
  • Memory is used to store executable instructions.
  • the processor is configured to execute the executable instructions stored in the memory, so as to perform the following operations: obtain the current motion mode of the movable platform, wherein the movable platform has multiple motion modes, and the control modes of the movable platform under different motion modes Different; according to the current motion mode of the movable platform, it is determined that the gimbal enters the corresponding gimbal mode.
  • the gimbal mode includes a stabilization mode for maintaining the stability of the load's attitude towards the ground, and a stabilization mode for maintaining the load and supporting mechanism. The relative attitude of the following mode is stable.
  • the movable platform may also include a positioning device and a detection device, the positioning device is used to obtain the position information of the movable platform, and the detection device is used to detect the surrounding obstacle information of the movable platform; in different motion modes, the positioning device and/or the detection device The usage status of the mobile platform is different, so that the movable platform has different control methods.
  • the plurality of motion modes may include a first motion mode.
  • the use state of the positioning device is turned on, and the use state of the detection device is to turn on the surrounding obstacle information for the movable platform in the first motion mode.
  • the processor may further perform the following operation: when the current motion mode of the movable platform is the first motion mode, determine that the pan/tilt head enters the stabilization mode.
  • the plurality of motion modes may include a second motion mode.
  • the use state of the positioning device is turned on, and the use state of the detection device is to turn on the surrounding obstacle information for the movable platform in the first motion mode.
  • the function of visual obstacle avoidance in the direction is turned off, and the surrounding obstacle information is used for the visual obstacle avoidance function of the movable platform in the second direction.
  • the processor may further perform the following operation: when the current motion mode of the movable platform is the second motion mode, determine that the pan/tilt head enters the stabilization mode.
  • the plurality of motion modes may include a third motion mode.
  • the use state of the positioning device is to turn off the function of the position information for controlling the position of the movable platform
  • the use state of the detection device is to turn off
  • the surrounding obstacle information is used for the visual obstacle avoidance function of the movable platform in the first direction and the second direction.
  • the processor also performs the following operation: when the current motion mode of the movable platform is the third motion mode, it is determined that the pan-tilt head enters the follow mode.
  • the processor may also perform the following operations: determine the reason why the movable platform is in the third motion mode; when the result of the judgment indicates that the reason why the movable platform is in the third motion mode is in response to the user When the input command is entered, the step of determining that the gimbal enters the follow mode is triggered.
  • the processor may also perform the following operations: when the result of the judgment indicates that the movable platform is in the third movement mode because the movable platform is automatically switched from the last movement mode to the third movement mode, determine that the gimbal remains in the last movement mode Corresponding stabilization mode or follow mode.
  • the positioning means may comprise a global positioning system, and the detection means may comprise a visual positioning system.
  • the triggering condition for the movable platform to automatically switch from the previous motion mode to the third motion mode may include a decrease in reliability of detection information of the global positioning system and the visual positioning system.
  • the processor may further perform the following operation: when the signal of the global positioning system is lower than a preset signal threshold, the reliability of determining the detection information of the global positioning system is reduced.
  • the processor may further perform the following operation: when the illumination around the movable platform is lower than the preset brightness threshold, the reliability of determining the detection information of the visual positioning system is reduced.
  • the plurality of motion modes may include a fourth motion mode.
  • the use state of the positioning device is turned on, and the use state of the detection device is to turn off the surrounding obstacle information for the movable platform to operate in the fourth motion mode.
  • the processor may also perform the following operation: when the current motion mode of the movable platform is the fourth motion mode, it is determined that the pan-tilt head enters the follow mode.
  • the first direction may include a vertical direction
  • the second direction may include a horizontal direction
  • the processor may also perform the following operation: when the movable platform performs a motion operation according to the preset control instruction, control the pan/tilt to be in a stabilization mode.
  • the processor may further perform the following operation: stop the step of triggering and detecting the motion mode that the movable platform is currently in during the process that the movable platform performs the motion operation according to the preset control instruction.
  • the movable platform may include an aircraft, and the preset control command may include a return home command or a landing command.
  • the processor can also perform the following operations: when the movable platform is powered on, it controls the PTZ to enter the follow mode.
  • the processor may further perform the following operation: stop triggering the step of detecting the motion mode currently in which the movable platform is located during the period from when the movable platform is powered on to when the set condition is satisfied.
  • the setting conditions may include: the time period after the movable platform is powered on reaches a time period threshold, or the movable platform obtains a motion mode selection instruction.
  • the processor can also perform the following operations: control the measured ground attitude of the load in the stabilization mode to be the target ground attitude corresponding to the target relative attitude angle of the load and the support mechanism in the follow mode .
  • the processor can also perform the following operations: control the measured relative attitude angle of the load and the support mechanism in the follow mode to the target relative attitude angle corresponding to the target ground attitude of the load in the stabilization mode .
  • the processor can also perform the following operations: determine the target relative attitude angle between the load and the support mechanism; obtain the measured relative attitude angle between the load and the support mechanism; control the gimbal according to the target relative attitude angle and the measured relative attitude angle , to keep the relative posture of the load and the support mechanism stable.
  • the processor may also perform the following operations: determine the target relative attitude angular velocity between the load and the support mechanism according to the target relative attitude angle and the measured relative attitude angle; obtain the measured relative attitude angular velocity between the load and the support mechanism; according to the target relative attitude angular velocity and the measured relative attitude angular velocity; The attitude angular velocity determines the control torque of the motor of the gimbal; the motor is controlled according to the control torque to keep the relative attitude of the load and the support mechanism stable.
  • the processor may also perform the following operations: acquire external disturbances to the gimbal, which can change the position and/or attitude of the gimbal; determine the control torque according to the target relative attitude angular velocity, the measured relative attitude angular velocity, and the external disturbance.
  • the processor can also perform the following operations: determine the ground target attitude angle of the load; obtain the ground measurement attitude angle of the load; control the gimbal according to the ground target attitude angle and the load ground measurement attitude angle , to keep the relative posture of the load and the support mechanism stable.
  • the ground target attitude angle of the load can be determined by the ground measurement attitude angle of the support mechanism.
  • the processor may also perform the following operations: determine the ground target angular velocity of the load according to the ground target attitude angle and the ground measurement attitude angle of the load; obtain the ground measurement angular velocity of the load; determine the cloud according to the ground target angular velocity and the ground measurement angular velocity Control torque of the motor of the platform; control the motor according to the control torque to keep the relative posture of the load and the support mechanism stable.
  • the processor may also perform the following operations: acquire external disturbances to the gimbal, which can change the position and/or attitude of the gimbal; determine the control torque according to the target angular velocity on the ground, the measured angular velocity on the ground, and the external disturbance.
  • This embodiment also provides a movable platform assembly, and the movable platform assembly includes a movable platform and a remote control terminal.
  • the movable platform is any of the above-mentioned movable platforms, and the remote control terminal is communicatively connected to the movable platform for controlling the movable platform, wherein the movement mode of the movable platform can be switched through the remote control terminal.
  • the remote control terminal may include a remote control or smart terminal of a mobile platform, such as a mobile phone, tablet, computer, smart bracelet, VR glasses, handle, etc., which can be switched by physical components (such as buttons or joysticks) or virtual buttons. Movement mode of the mobile platform.
  • the movable platform is an unmanned aerial vehicle
  • the P, S, M, and A gears described above can be switched by the user manually operating the remote control terminal, and the A gear can also be automatically entered by the movable platform.

Abstract

A control method for a movable platform, a computer-readable storage medium, a control device for a movable platform, a movable platform and a movable platform assembly. The control method comprises: acquiring a current movement mode of a movable platform, wherein the movable platform has a plurality of movement modes, the movable platform in different control modes has different control manners, and the movable platform comprises a gimbal for loading a load and a support mechanism for supporting the gimbal; and determining, according to the current movement mode of the movable platform, that the gimbal enters a corresponding gimbal mode, the gimbal mode including a stabilizing mode for keeping the posture of the load relative to the ground stabilized, and a following mode for keeping the posture of the load relative to the support mechanism stabilized. The method reduces the operation difficulty of the movable platform, and if the current movement mode of the mobile platform is different, the control manners of the gimbal for the posture of the load can satisfy the requirements of different movement modes.

Description

可移动平台及其控制方法、装置Movable platform and its control method and device 技术领域technical field
本申请涉及可移动平台技术领域,更具体地涉及一种可移动平台的控制方法、计算机可读存储介质、可移动平台的控制装置、可移动平台以及可移动平台组件。The present application relates to the technical field of movable platforms, and more particularly, to a control method of a movable platform, a computer-readable storage medium, a control device of a movable platform, a movable platform, and a movable platform assembly.
背景技术Background technique
可移动平台可以通过云台来搭载负载,以实现对负载的姿态的控制。然而,基于应用场景的变化,可移动平台本体的姿态控制方式具有多样性,云台对负载姿态的控制方式也具有多样性,使得用户需要同时考虑对可移动平台本体以及云台的控制,但当用户面临的场景较复杂,需要频繁操作或切换可移动平台及云台的功能时,增加了可移动平台的操作难度,降低了用户的使用体验。The movable platform can carry the load through the gimbal to realize the control of the attitude of the load. However, based on changes in application scenarios, the attitude control methods of the movable platform body are diverse, and the control methods of the gimbal to the load attitude are also diverse, so that users need to consider the control of the movable platform body and the gimbal at the same time, but When the user faces a complex scene and needs to frequently operate or switch the functions of the movable platform and the PTZ, the operation difficulty of the movable platform is increased, and the user experience is reduced.
发明内容SUMMARY OF THE INVENTION
鉴于上述问题,提出了一种克服上述问题或者至少部分地解决上述问题的可移动平台的控制方法、计算机可读存储介质、可移动平台的控制装置、可移动平台以及可移动平台组件。In view of the above problems, a method for controlling a movable platform, a computer readable storage medium, a control device for a movable platform, a movable platform, and a movable platform assembly are provided to overcome the above problems or at least partially solve the above problems.
根据本申请的第一个方面,提供了一种可移动平台的控制方法,所述控制方法包括:获取所述可移动平台当前所处的运动模式,其中,所述可移动平台具有多个运动模式,不同运动模式下的所述可移动平台的控制方式不同,且所述可移动平台包括用于搭载负载的云台以及用于支撑所述云台的支撑机构;根据所述可移动平台的当前所处的所述运动模式,确定所述云台进入相应的云台模式,所述云台模式包括用于保持所述负载的对地姿态稳定的增稳模式、以及用于保持所述负载与所述支撑机构的相对姿态稳定的跟随模式。According to a first aspect of the present application, there is provided a control method for a movable platform, the control method comprising: acquiring a current motion mode of the movable platform, wherein the movable platform has multiple motions In different motion modes, the movable platform has different control methods, and the movable platform includes a pan/tilt for carrying loads and a support mechanism for supporting the pan/tilt; according to the movement of the movable platform In the current motion mode, it is determined that the gimbal enters a corresponding gimbal mode, where the gimbal mode includes a stabilization mode for maintaining a stable attitude of the payload to the ground, and a stabilization mode for maintaining the payload The following mode is stable relative to the posture of the support mechanism.
根据本申请的第二个方面,提供了一种计算机可读存储介质,其存储有可执行指令,所述可执行指令在由一个或多个处理器执行时,可以使所述一个或多个处理器执行本申请的第一个方面提供的控制方法。According to a second aspect of the present application, there is provided a computer-readable storage medium storing executable instructions that, when executed by one or more processors, cause the one or more processors to The processor executes the control method provided by the first aspect of the present application.
根据本申请的第三个方面,提供了一种可移动平台的控制装置,所述控制装置包括:存储器,用于存储可执行指令;处理器,用于执行所述存储器中存储的所述可执行指令,以执行如下操作:获取所述可移动平台当前所处的运动模式,其中,所述可移动平台具有多个运动模式,不同运动模式下的所述可移动平台的控制方式不同,所述可移动平台包括用于搭载负载的云台以及用于支撑所述云台的支撑机构;根据所述可移动平台当前所处的所述运动模式,确定所述云台进入相应的云台模式,所述云台模式包括用于保持所述负载的对地姿态稳定的增稳模式、以及用于保持所述负载与所述支撑机构的相对姿态稳定的跟随模式。According to a third aspect of the present application, there is provided a control apparatus for a mobile platform, the control apparatus comprising: a memory for storing executable instructions; a processor for executing the executable instructions stored in the memory Execute the instruction to perform the following operations: obtain the current motion mode of the movable platform, wherein the movable platform has multiple motion modes, and the control modes of the movable platform under different motion modes are different, so The movable platform includes a pan-tilt for carrying loads and a support mechanism for supporting the pan-tilt; according to the motion mode that the movable platform is currently in, it is determined that the pan-tilt enters a corresponding pan-tilt mode , the pan-tilt mode includes a stabilization mode for keeping the attitude of the load relative to the ground stable, and a follow mode for keeping the relative attitude of the load and the support mechanism stable.
根据本申请的第四个方面,提供了一种可移动平台,所述可移动平台包括用于搭载负载的云台以及用于支撑所述云台的支撑机构;所述可移动平台还包括:存储器,用于存储可执行指令;处理器,用于执行所述存储器中存储的所述可执行指令,以执行如下操作:获取所述可移动平台当前所处的运动模式,其中,所述可移动平台具有多个运动模式,不同运动模式下的所述可移动平台的控制方式不同;According to a fourth aspect of the present application, a movable platform is provided, the movable platform includes a pan-tilt for carrying loads and a support mechanism for supporting the pan-tilt; the movable platform further comprises: a memory for storing executable instructions; a processor for executing the executable instructions stored in the memory to perform the following operations: acquiring the motion mode currently in which the movable platform is located, wherein the executable instructions The mobile platform has multiple motion modes, and the control modes of the movable platform under different motion modes are different;
根据所述可移动平台的当前所处的所述运动模式,确定所述云台进入相应的云台模式,所述云台模式包括用于保持所述负载的对地姿态稳定的增稳模式、以及用于保持所述负载与所述支撑机构的相对姿态稳定的跟随模式。According to the motion mode that the movable platform is currently in, it is determined that the gimbal enters a corresponding gimbal mode, and the gimbal mode includes a stabilization mode for maintaining a stable attitude of the load to the ground, and a following mode for keeping the relative posture of the load and the support mechanism stable.
根据本申请的第五个方面,提供了一种可移动平台组件,可移动平台组件包括:上述任一所述的可移动平台;遥控终端,所述遥控终端与所述可移动平台通信连接,用于控制所述可移动平台,其中,所述可移动平台的运动模式能够通过所述遥控终端进行切换。According to a fifth aspect of the present application, a movable platform assembly is provided, and the movable platform assembly includes: any of the movable platforms described above; a remote control terminal, wherein the remote control terminal is communicatively connected to the movable platform, It is used to control the movable platform, wherein the movement mode of the movable platform can be switched by the remote control terminal.
本申请中,可移动平台可以同时具有增稳模式以及跟随模式这两种云台模式,其中,在增稳模式下,可移动平台可以用来拍摄出稳定 画面的图像,在跟随模式下,可移动平台可以使得用户体验可移动平台的第一人称视角。本申请通过获取可移动平台当前所处的运动模式,并根据获取的结果确定云台进入相应的云台模式,即增稳模式或跟随模式,由此,云台对负载姿态的控制方式简单、快捷,降低了可移动平台的操作难度。并且,云台对负载姿态的控制方式可以适配可移动平台当前所处的运动模式,使得可移动平台在当前所处的运动模式不同的情况下,云台对负载姿态的控制方式都能满足不同运动模式的需求。In this application, the movable platform can have two pan-tilt modes, namely stabilization mode and follow mode. In the stabilization mode, the movable platform can be used to capture images of stable images. The mobile platform may allow the user to experience the first-person perspective of the mobile platform. The present application obtains the current motion mode of the movable platform, and determines that the gimbal enters the corresponding gimbal mode, that is, the stabilization mode or the follow mode, according to the obtained result. Therefore, the gimbal controls the load attitude in a simple and convenient manner. It is fast and reduces the difficulty of operating the mobile platform. In addition, the control method of the gimbal to the load attitude can be adapted to the current motion mode of the movable platform, so that the control method of the gimbal to the load attitude can satisfy the current movement mode of the movable platform. The needs of different sports modes.
本申请的附加方面和优点将在下面的描述部分中变得明显,或通过本申请的实践了解到。本申请内容中提供的仅仅是一个实施例,而不是本申请本身,本申请内容的效果仅仅是实施例的效果,而不是本申请所有的、全部的技术效果。Additional aspects and advantages of the present application will become apparent in the description section below, or learned by practice of the present application. What is provided in the content of this application is only an embodiment, not the application itself, and the effect of the content of the application is only the effect of the embodiment, rather than all the technical effects of the application.
附图说明Description of drawings
通过下文中参照附图对本申请所作的描述,本申请的其它目的和优点将显而易见,并可帮助对本申请有全面的理解。其中:Other objects and advantages of the present application will be apparent from the following description of the present application with reference to the accompanying drawings, and may assist in a comprehensive understanding of the present application. in:
图1是根据本申请的一个实施例的可移动平台的结构示意图;1 is a schematic structural diagram of a movable platform according to an embodiment of the present application;
图2是根据本申请的一个实施例的可移动平台的云台处于增稳模式的示意图;2 is a schematic diagram of a gimbal of a movable platform in a stabilization mode according to an embodiment of the present application;
图3是根据本申请的一个实施例的可移动平台的云台处于跟随模式的示意图;FIG. 3 is a schematic diagram of a pan/tilt head of a movable platform in a follow mode according to an embodiment of the present application;
图4是根据本申请的一个实施例的可移动平台处于第一运动模式时的原理图;FIG. 4 is a schematic diagram of a movable platform in a first motion mode according to an embodiment of the present application;
图5是根据本申请的一个实施例的可移动平台处于第二运动模式时的原理图;5 is a schematic diagram of the movable platform in a second motion mode according to an embodiment of the present application;
图6是根据本申请的一个实施例的可移动平台处于第三运动模式时的原理图;6 is a schematic diagram of the movable platform in a third motion mode according to an embodiment of the present application;
图7是根据本申请的一个实施例的可移动平台响应于用户输入指令而处于第三运动模式的原理图;7 is a schematic diagram of a movable platform in a third motion mode in response to a user input instruction according to an embodiment of the present application;
图8是根据本申请的一个实施例的可移动平台处于第四运动模式时的原理图;8 is a schematic diagram of the movable platform in a fourth motion mode according to an embodiment of the present application;
图9是根据本申请的一个实施例的可移动平台的云台由跟随模式进入增稳模式时的原理图;FIG. 9 is a schematic diagram when the gimbal of the movable platform enters the stabilization mode from the follow mode according to an embodiment of the present application;
图10是根据本申请的一个实施例的可移动平台的云台由增稳模式进入跟随模式时的原理图;FIG. 10 is a schematic diagram when the gimbal of the movable platform enters the follow mode from the stabilization mode according to an embodiment of the present application;
图11是根据本申请的一个实施例的可移动平台的云台处于增稳模式时的控制原理图;FIG. 11 is a control principle diagram when the gimbal of the movable platform is in the stabilization mode according to an embodiment of the present application;
图12是根据本申请的一个实施例的可移动平台的云台处于跟随模式时的控制原理图;Fig. 12 is a control principle diagram when the pan/tilt of the movable platform is in a follow mode according to an embodiment of the present application;
图13是根据本申请的另一个实施例的可移动平台的云台处于跟随模式时的控制原理图。FIG. 13 is a control principle diagram when the pan/tilt of the movable platform is in a follow mode according to another embodiment of the present application.
应该注意的是,附图并未按比例绘制,并且出于说明目的,在整个附图中类似结构或功能的元素通常用类似的附图标记来表示。还应该注意的是,附图只是为了便于描述优选实施例,而不是本申请本身。附图没有示出所描述的实施例的每个方面,并且不限制本申请的范围。It should be noted that the drawings are not to scale and that, for illustration purposes, elements of similar structure or function are generally designated by like reference numerals throughout the drawings. It should also be noted that the drawings are for convenience only in describing the preferred embodiments and not the application itself. The drawings do not illustrate every aspect of the described embodiments, and do not limit the scope of the application.
图中,10为可移动平台,100为负载,200为云台,300为支撑机构,400为定位装置,500为检测装置。In the figure, 10 is a movable platform, 100 is a load, 200 is a head, 300 is a support mechanism, 400 is a positioning device, and 500 is a detection device.
具体实施方式Detailed ways
下面详细描述本申请的实施方式,所述实施方式的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施方式是示例性的,仅用于解释本申请,而不能理解为对本申请的限制。Embodiments of the present application are described in detail below, examples of which are illustrated in the accompanying drawings, wherein the same or similar reference numerals refer to the same or similar elements or elements having the same or similar functions throughout. The embodiments described below with reference to the accompanying drawings are exemplary, only used to explain the present application, and should not be construed as a limitation on the present application.
在本申请的描述中,需要理解的是,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括但不限于一个或者更多个所述特征。In the description of the present application, it should be understood that the terms "first" and "second" are only used for description purposes, and cannot be interpreted as indicating or implying relative importance or implicitly indicating the number of indicated technical features. Thus, features defined as "first" and "second" may expressly or implicitly include, but are not limited to, one or more of said features.
下文的公开提供了许多不同的实施方式或例子用来实现本申请。为了简化本申请的公开,下文中对特定例子的部件和方法进行描述。当然,它们仅仅为示例,并且目的不在于限制本申请。此外,本申请可以在不同例子中重复参考数字和/或参考字母,这种重复是为了简化和清楚的目的,其本身不指示所讨论各种实施方式和/或设置之间的关系。The following disclosure provides many different embodiments or examples for implementing the present application. In order to simplify the disclosure of the present application, the components and methods of specific examples are described below. Of course, they are only examples and are not intended to limit the application. Furthermore, this application may repeat reference numerals and/or reference letters in different instances for the purpose of simplicity and clarity, and does not in itself indicate a relationship between the various embodiments and/or arrangements discussed.
本实施例,首先提供了一种可移动平台的控制方法,可移动平台包括用于搭载负载的云台以及用于支撑云台的支撑机构。This embodiment first provides a control method for a movable platform, where the movable platform includes a pan-tilt for carrying loads and a support mechanism for supporting the pan-tilt.
其中,支撑机构可以包括但不限于无人车的底盘、机器人的机身或无人机的机身。也即,可移动平台可以包括无人车、无人机或机器人。Wherein, the support mechanism may include but not limited to the chassis of the unmanned vehicle, the fuselage of the robot or the fuselage of the drone. That is, the movable platform may include unmanned vehicles, drones, or robots.
在一些实施例中,负载可以为成像装置,例如可以为照相机、摄像机等,具体地,可以为单反相机、微单相机等。在另一些实施例中,负载可以为智能终端,例如具有拍摄功能的手机、平板等。在其他实施例中,负载还可以为其他需要被移动、操作或调整姿态的装置,例如,麦克风。In some embodiments, the payload may be an imaging device, for example, a camera, a video camera, etc., specifically, a single-lens reflex camera, a mirrorless camera, and the like. In other embodiments, the load may be a smart terminal, such as a mobile phone, tablet, etc. with a photographing function. In other embodiments, the payload may also be other devices that need to be moved, manipulated, or attitude adjusted, such as a microphone.
其中,云台可以包括一个云台部件、两个云台部件、三个云台部件或更多个云台部件。相应地,云台可以允许负载绕一个、两个、三个或更多个轴旋转,用于旋转的轴可以彼此正交,也可以不是正交。在一些实施例中,云台部件可以通过电机可以控制负载的姿态,包括控制负载的俯仰角、横滚角以及偏航角中的一个或多个。相应地,负载可以绕俯仰轴P、横滚轴R以及偏航轴Y中的一个或多个旋转。Wherein, the PTZ may include one PTZ component, two PTZ components, three PTZ components or more PTZ components. Accordingly, the head may allow the load to rotate about one, two, three or more axes, and the axes for rotation may or may not be orthogonal to each other. In some embodiments, the gimbal component can control the attitude of the payload through a motor, including controlling one or more of the payload's pitch angle, roll angle, and yaw angle. Accordingly, the payload may rotate about one or more of the pitch axis P, the roll axis R, and the yaw axis Y.
在一些实施例中,云台部件可以为3个,如第一云台部件、第二云台部件以及第三云台部件。可以理解地,每个云台部件可以包括连接臂。其中,第一云台部件与支撑机构连接,并且第一云台部件可以相对支撑机构转动,以使得负载的偏航角发生变化,即第一连接臂相对支撑机构转动时,可以使得负载绕偏航轴Y旋转。第二云台部件与第一云台部件连接,并且第二云台部件可以相对支撑机构转动,以使得负载的横滚角发生变化,即第二云台部件相对支撑机构转动时,可以使得负载绕横滚轴R旋转。第三云台部件与第二云台部件连接,并 且第三云台部件可以相对支撑机构转动,以使得负载的俯仰角发生变化,即第三云台部件相对支撑机构转动时,可以使得负载绕俯仰轴P旋转。In some embodiments, there may be three pan-tilt parts, such as a first pan-tilt part, a second pan-tilt part, and a third pan-tilt part. It will be appreciated that each pan/tilt member may include a connecting arm. The first pan-tilt member is connected to the support mechanism, and the first pan-tilt member can rotate relative to the support mechanism, so that the yaw angle of the load changes, that is, when the first connecting arm rotates relative to the support mechanism, the load can be rotated around the yaw angle. The Y axis rotates. The second pan-tilt part is connected to the first pan-tilt part, and the second pan-tilt part can rotate relative to the support mechanism, so that the roll angle of the load changes, that is, when the second pan-tilt part rotates relative to the support mechanism, the load can be rotated Rotate around the roll axis R. The third pan-tilt part is connected with the second pan-tilt part, and the third pan-tilt part can rotate relative to the support mechanism, so that the pitch angle of the load changes, that is, when the third pan-tilt part rotates relative to the support mechanism, the load can be rotated around the support mechanism. The pitch axis P rotates.
在另一些实施例中,云台可以仅包括一个云台部件。这个云台部件可以相对支撑机构转动,以使得负载的偏航角发生变化,即这个云台部件相对支撑机构转动时,可以使得负载绕偏航轴Y旋转。In other embodiments, the pan/tilt may include only one pan/tilt component. The head part can be rotated relative to the support mechanism to change the yaw angle of the load, that is, when the head part is rotated relative to the support mechanism, the load can be rotated around the yaw axis Y.
可以理解地,云台部件与支撑机构可以有各种对应关系。例如,支撑机构为无人机机身时,与无人机机身连接的云台可以有一个云台部件、两个云台部件、三个云台部件或更多个云台部件,并且可以使得负载可以绕俯仰轴、横滚轴以及偏航轴中的一个、两个或三个旋转,从而使得负载也可以绕更多的轴旋转等。支撑机构为机器人的机身或无人车的底盘时,云台也可以有一个云台部件、两个云台部件、三个云台部件或三个以上的云台部件,并且可以使得负载可以绕俯仰轴、横滚轴以及偏航轴中的一个、两个或三个旋转,从而使得负载也可以绕三个以上的轴旋转等。也就是说,不论支撑机构是什么类型,云台都既可以为单轴云台、双轴云台、三轴云台或其他轴数的云台。It can be understood that there may be various correspondences between the pan/tilt components and the support mechanism. For example, when the supporting mechanism is the drone body, the gimbal connected to the drone body can have one gimbal part, two gimbal parts, three gimbal parts or more gimbal parts, and can The load can be rotated about one, two or three of the pitch, roll and yaw axes, so that the load can also be rotated about more axes, etc. When the supporting mechanism is the body of the robot or the chassis of the unmanned vehicle, the gimbal can also have one gimbal part, two gimbal parts, three gimbal parts or more than three gimbal parts, and the load can be Rotate about one, two or three of the pitch, roll, and yaw axes, so that the load can also rotate about more than three axes, etc. That is to say, regardless of the type of support mechanism, the gimbal can be a single-axis gimbal, a two-axis gimbal, a three-axis gimbal or a gimbal with other axes.
图1是根据本申请的一个实施例的可移动平台的结构示意图,该可移动平台10以无人机为例。可以理解地,无人机通常也被称为UAV(Unmanned Aerial Vehicle,无人飞行器),其中,无人机可以包括固定翼无人机、旋翼无人机、伞翼无人机等各种类型。可以理解地,云台200与无人机的机身的连接处并不限于图1所示的位置,也就是说,云台200不仅可以与无人机的底部连接,也可以与无人机的顶部、侧部等位置连接,本实施例对此并不加以限制。FIG. 1 is a schematic structural diagram of a movable platform according to an embodiment of the present application, and the movable platform 10 is an example of an unmanned aerial vehicle. Understandably, UAVs are also commonly referred to as UAVs (Unmanned Aerial Vehicles), wherein UAVs can include fixed-wing UAVs, rotary-wing UAVs, umbrella-wing UAVs, etc. . Understandably, the connection between the gimbal 200 and the fuselage of the UAV is not limited to the position shown in FIG. 1 , that is, the gimbal 200 can not only be connected to the bottom of the UAV, but also can be connected to the UAV. The top and side parts are connected to each other, which is not limited in this embodiment.
在一些实施例中,该可移动平台可以为无人车,例如,可以为可遥控的无人车。则支撑机构可以包括无人车的底盘。可以理解地,底盘可以用于支撑云台,且底盘的移动方式可以直接利用轮子进行移动,也可以通过履带等其他机构移动。其中,当无人车直接利用轮子进行移动时,无人车的轮子的数量可以为一个或多个,本实施例对此并不加以限定。In some embodiments, the movable platform may be an unmanned vehicle, eg, a remotely controlled unmanned vehicle. Then the support mechanism may include the chassis of the unmanned vehicle. It can be understood that the chassis can be used to support the gimbal, and the movement of the chassis can be directly moved by wheels, or by other mechanisms such as crawlers. Wherein, when the unmanned vehicle directly uses wheels to move, the number of wheels of the unmanned vehicle may be one or more, which is not limited in this embodiment.
在另一些实施例中,该可移动平台可以为机器人。则支撑机构可 以包括机器人的机身。可以理解地,云台不仅可以与机器人的机身的机器头部连接,也可以与器人的机身的机器手臂、机器背部等其他部位连接,本实施例对此并不加以限定。In other embodiments, the movable platform may be a robot. The support mechanism may then comprise the body of the robot. It can be understood that the pan/tilt can be connected not only to the head of the robot body, but also to other parts of the robot body such as the robot arm and the back of the robot, which is not limited in this embodiment.
云台具有用于保持负载的对地姿态稳定的增稳模式以及用于保持负载与支撑机构的相对姿态稳定的跟随模式。The gimbal has a stabilization mode for keeping the ground attitude of the load stable and a follow mode for keeping the relative attitude of the load and the support mechanism stable.
图2是根据本申请的一个实施例的可移动平台的云台处于增稳模式的示意图,图3是根据本申请的一个实施例的可移动平台的云台处于跟随模式的示意图。FIG. 2 is a schematic diagram of the gimbal of the movable platform in a stabilization mode according to an embodiment of the present application, and FIG. 3 is a schematic diagram of the gimbal of the movable platform in a follow mode according to an embodiment of the present application.
请参见图1以及图2,当可移动平台10处于增稳模式时,由于云台200用于保持负载100的对地姿态稳定,因此,即使支撑机构300的姿态发生了变化,负载100的对地姿态稳定也是稳定的。因此,在增稳模式下,当负载100为成像装置时,可以使得成像装置稳定成像,可以理解地,当可移动平台10为无人机时,则可以进行航拍。在增稳模式下,当负载100为麦克风时,可以使得麦克风采集稳定的声音。Referring to FIG. 1 and FIG. 2 , when the movable platform 10 is in the stabilization mode, since the gimbal 200 is used to keep the ground-facing attitude of the payload 100 stable, even if the attitude of the support mechanism 300 changes, the orientation of the payload 100 to the ground is stable. The ground attitude is also stable. Therefore, in the stabilization mode, when the payload 100 is an imaging device, the imaging device can be stabilized for imaging, and it is understandable that when the movable platform 10 is an unmanned aerial vehicle, aerial photography can be performed. In the stabilization mode, when the load 100 is a microphone, the microphone can be made to collect stable sound.
请参见图1以及图3,当可移动平台10处于跟随模式时,由于云台200用于保持负载100与支撑机构300的相对姿态稳定,因此,当支撑机构300的姿态发生了变化,负载100的姿态也会跟着变化。因此,在跟随模式下,当负载100为成像装置时,可以使得成像装置拍出第一人称视角的图像,可以理解地,当可移动平台10为无人机时,则可以使得用户体验第一人称视角的飞行。在跟随模式下,当负载为麦克风时,可以使得麦克风采集与第一人称视角对应的声音。Referring to FIG. 1 and FIG. 3 , when the movable platform 10 is in the follow mode, since the gimbal 200 is used to keep the relative posture of the load 100 and the support mechanism 300 stable, when the posture of the support mechanism 300 changes, the load 100 The posture will also change. Therefore, in the follow mode, when the payload 100 is an imaging device, the imaging device can be made to take an image from a first-person perspective. Understandably, when the movable platform 10 is a drone, the user can experience a first-person perspective. flight. In the follow mode, when the load is a microphone, the microphone can be made to collect the sound corresponding to the first-person perspective.
本实施例提供的可移动平台的控制方法包括:获取可移动平台当前所处的运动模式,其中,可移动平台具有多个运动模式,不同运动模式下的可移动平台的控制方式不同;根据无人机的当前所处的运动模式,确定云台进入相应的云台模式。The control method of the movable platform provided by this embodiment includes: acquiring the motion mode that the movable platform is currently in, wherein the movable platform has multiple motion modes, and the control modes of the movable platform under different motion modes are different; The current motion mode of the HMI determines that the gimbal enters the corresponding gimbal mode.
本申请实施例中,可移动平台可以同时具有增稳模式以及跟随模式这两种云台模式,其中,在增稳模式下,可移动平台可以用来拍摄出稳定画面的图像,在跟随模式下,可移动平台可以使得用户体验可移动平台的第一人称视角。本申请实施例通过获取可移动平台当前所 处的运动模式,并根据获取的结果确定云台进入相应的云台模式,即增稳模式或跟随模式,由此,云台对负载姿态的控制方式不需要用户额外地主动调节,降低了可移动平台的操作难度。并且,云台对负载姿态的控制方式可以适配可移动平台当前所处的运动模式,使得可移动平台在当前所处的运动模式不同的情况下,云台对负载姿态的控制方式都能满足不同运动模式的需求。In the embodiment of the present application, the movable platform may have two pan/tilt modes, namely stabilization mode and follow mode. In the stabilization mode, the movable platform can be used to capture images of stable images. , the movable platform can enable the user to experience the first-person perspective of the movable platform. In this embodiment of the present application, the current motion mode of the movable platform is obtained, and it is determined according to the obtained result that the gimbal enters the corresponding gimbal mode, that is, the stabilization mode or the follow mode. There is no need for additional active adjustment by the user, which reduces the operation difficulty of the movable platform. In addition, the control method of the gimbal to the load attitude can be adapted to the current motion mode of the movable platform, so that the control method of the gimbal to the load attitude can satisfy the current movement mode of the movable platform. The needs of different sports modes.
其中,可以理解,本申请实施例的执行主体可以是可移动平台的遥控终端,也可以是可移动平台的控制器,以在确定相应的云台模式后,可以控制云台进入相应的云台模式,进行相应的姿态调节。It can be understood that the execution body of the embodiment of the present application may be a remote control terminal of the movable platform, or may be a controller of the movable platform, so as to control the PTZ to enter the corresponding PTZ after determining the corresponding PTZ mode. mode, and adjust the posture accordingly.
在一些实施例中,可移动平台还可以包括定位装置和检测装置,定位装置用于获取可移动平台的位置信息,检测装置用于检测可移动平台的周围障碍物信息。In some embodiments, the movable platform may further include a positioning device and a detection device, the positioning device is used for acquiring the position information of the movable platform, and the detection device is used for detecting the surrounding obstacle information of the movable platform.
不同运动模式下,定位装置和/或检测装置的使用状态不同,以使得可移动平台具有不同的控制方式。也就是说,不同的运动模式间可以仅仅是定位装置的使用状态不同,也可以仅仅是检测装置的使用状态不同,还可以是定位装置和检测装置的使用状态都不同。In different motion modes, the use states of the positioning device and/or the detection device are different, so that the movable platform has different control modes. That is to say, between different motion modes, only the use state of the positioning device may be different, or only the use state of the detection device may be different, or the use state of the positioning device and the detection device may be different.
这种定位装置和/或检测装置的使用状态不同,可以使得可移动平台具有的不同的控制方式,例如,具有适合拍摄稳定图像或采集稳定的声音的控制方式,也具有适合让用户体验第一人称视角的体验的控制方式,因此,将这种运动模式与云台的不同模式对应,可以满足用户多样性的需求。The different usage states of the positioning device and/or the detection device can make the movable platform have different control modes, for example, a control mode suitable for capturing stable images or capturing a stable sound, and a control mode suitable for users to experience the first-person perspective. The control method of the viewing angle experience, therefore, this motion mode corresponds to the different modes of the gimbal, which can meet the diverse needs of users.
进一步的,在这种定位装置和/或检测装置的使用状态不同,使得可移动平台具有的不同的控制方式中,可移动平台的运动参数(移动速度)的调控范围可以是不同的,可移动平台的运动参数的控制受用户的指令的影响可以是不同的(如在定位装置和/或检测装置的使用状态不同的情况下,被控的运动参数的种类不同,以使得可移动平台的控制方式发生变化),可移动平台的运动状态也可以是不同的(例如,当可移动平台是飞行器时,在定位装置和/或检测装置的使用状态不同的情况下,飞行器可以由允许实现悬停变更为不允许实现悬停)。示例性的,可以是可移动平台具有相对较快的移动速度时与跟 随模式对应,可移动平台具有相对较慢的移动速度时与增稳模式对应;可移动平台的运动参数的控制受用户的指令的影响较大时与跟随模式对应,可移动平台的运动参数的控制受用户的指令的影响较小时与增稳模式对应;可移动平台为飞行器时,飞行器可以实现悬停与增稳模式对应,飞行器不可以实现悬停与跟随模式对应。Further, in the different use states of the positioning device and/or the detection device, in the different control modes that the movable platform has, the control range of the movement parameter (moving speed) of the movable platform can be different, and the movable platform can be moved. The control of the motion parameters of the platform may be affected by the user's instructions in different ways (for example, in the case of different use states of the positioning device and/or the detection device, the types of the motion parameters to be controlled are different, so that the control of the movable platform can be different. (for example, when the movable platform is an aircraft, in the case of different usage states of the positioning device and/or the detection device, the aircraft may be allowed to hover by allowing the Changed to not allow hovering). Exemplarily, when the movable platform has a relatively fast movement speed, it corresponds to the follow mode, and when the movable platform has a relatively slow movement speed, it corresponds to the stabilization mode; the movement parameters of the movable platform are controlled by the user. When the influence of the command is large, it corresponds to the follow mode. When the control of the motion parameters of the movable platform is less affected by the user's command, it corresponds to the stabilization mode. When the movable platform is an aircraft, the aircraft can hover and correspond to the stabilization mode. , the aircraft cannot implement hovering and following mode.
该多个运动模式可以包括第一运动模式,图4是根据本申请的一个实施例的可移动平台处于第一运动模式时的原理图。如图4所示,当可移动平台10处于第一运动模式时,定位装置400的使用状态为开启,检测装置500的使用状态为开启周围障碍物信息用于可移动平台100在第一方向以及第二方向上视觉避障的功能。The plurality of motion modes may include a first motion mode, and FIG. 4 is a schematic diagram of the movable platform according to an embodiment of the present application when the movable platform is in the first motion mode. As shown in FIG. 4 , when the movable platform 10 is in the first motion mode, the use state of the positioning device 400 is turned on, and the use state of the detection device 500 is to turn on the surrounding obstacle information for the movable platform 100 in the first direction and The function of visual obstacle avoidance in the second direction.
周围障碍物信息用于可移动平台100在第一方向上视觉避障可以包括:周围障碍物信息用于控制可移动平台100在第一方向上的移动速度,例如,当周围障碍物信息指示在第一方向上预设距离具有障碍物时,则降低可移动平台在第一方向上的速度或禁止可移动平台沿第一方向移动。The surrounding obstacle information is used for the visual obstacle avoidance of the movable platform 100 in the first direction may include: surrounding obstacle information is used to control the moving speed of the movable platform 100 in the first direction, for example, when the surrounding obstacle information indicates that the When there is an obstacle in the preset distance in the first direction, the speed of the movable platform in the first direction is reduced or the movement of the movable platform in the first direction is prohibited.
周围障碍物信息用于可移动平台100在第二方向上视觉避障可以包括:周围障碍物信息用于控制可移动平台100在第二方向上的移动速度,例如,当周围障碍物信息指示在第二方向上预设距离具有障碍物时,则降低可移动平台在第二方向上的速度或禁止可移动平台沿第二方向移动。The surrounding obstacle information is used for the visual obstacle avoidance of the movable platform 100 in the second direction may include: surrounding obstacle information is used to control the moving speed of the movable platform 100 in the second direction, for example, when the surrounding obstacle information indicates that the When there is an obstacle in the preset distance in the second direction, the speed of the movable platform in the second direction is reduced or the movement of the movable platform in the second direction is prohibited.
可以理解地,定位装置400的使用状态为开启,即定位装置400可以获取可移动平台10的位置信息,在一些实施例中,定位装置400的使用状态为开启时,获取到的位置信息可以用于控制可移动平台10的位置,也可以不用于控制可移动平台10的位置。It can be understood that when the use state of the positioning device 400 is on, that is, the positioning device 400 can obtain the position information of the movable platform 10. In some embodiments, when the use state of the positioning device 400 is on, the obtained position information can be used for For controlling the position of the movable platform 10 , it may not be used for controlling the position of the movable platform 10 .
在一些实施例中,定位装置可以包括全球定位系统,全球定位系统可以全球全天候定位,并且具有定位精度高、观测时间短等优点。在其他实施例中,定位装置也可以包括捷联惯导系统、无线定位系统等。In some embodiments, the positioning device may include a global positioning system, and the global positioning system can position all-weather around the world, and has the advantages of high positioning accuracy and short observation time. In other embodiments, the positioning device may also include a strapdown inertial navigation system, a wireless positioning system, or the like.
检测装置可以包括视觉定位系统。由此,检测装置不仅可以用于检测可移动平台的周围障碍物信息,还可以在定位装置的可靠性较 低,且检测装置的可靠性较高时,起到获取可移动平台的位置信息的作用,也就是说,在定位装置的可靠性较高时,可以通过定位装置获取的位置信息控制可移动平台的位置,在定位装置的可靠性较低,且检测装置的可靠性较高时,可以通过检测装置获取的位置信息控制可移动平台的位置。在其他实施例中,检测装置还可以包括视觉传感器、利用超声波检测可移动平台的周围障碍物信息的装置等。The detection means may comprise a visual positioning system. Therefore, the detection device can not only be used to detect the surrounding obstacle information of the movable platform, but also can be used to obtain the position information of the movable platform when the reliability of the positioning device is low and the reliability of the detection device is relatively high. That is to say, when the reliability of the positioning device is high, the position of the movable platform can be controlled by the position information obtained by the positioning device. When the reliability of the positioning device is low and the reliability of the detection device is high, The position of the movable platform can be controlled by the position information obtained by the detection device. In other embodiments, the detection device may further include a visual sensor, a device for detecting information about obstacles around the movable platform using ultrasonic waves, and the like.
图4中,以第一方向为可移动平台的下方向,且第二方向为可移动平台的前方向以及后方向为例。但可以理解地,在其他实施例中,第一方向以及第二方向可以为其他情况,例如,第一方向可以包括可移动平台的竖直方向上的任何方向,第二方向可以包括可移动平台的水平方向上的任何方向。第一方向以及第二方向可以与可移动平台的水平方向或竖直方向成任何夹角。该夹角可以为0度、10度、20度、30度、40度、50度、60度、70度、80度或90度等。In FIG. 4 , the first direction is the downward direction of the movable platform, and the second direction is the front and rear directions of the movable platform as an example. However, it should be understood that in other embodiments, the first direction and the second direction may be other situations. For example, the first direction may include any direction in the vertical direction of the movable platform, and the second direction may include the movable platform. any direction in the horizontal direction. The first direction and the second direction may form any angle with the horizontal or vertical direction of the movable platform. The included angle may be 0 degrees, 10 degrees, 20 degrees, 30 degrees, 40 degrees, 50 degrees, 60 degrees, 70 degrees, 80 degrees, or 90 degrees.
当可移动平台为无人机时,第一方向为下方向,且第二方向为前方向以及后方向,从而便于无人机执行飞行任务、返航以及降落。当可移动平台为无人车或机器人时,第一方向为下方向,且第二方向为前方向以及后方向,从而便于无人车或机器人执行任务、返航以及避免移动受阻。When the movable platform is an unmanned aerial vehicle, the first direction is the downward direction, and the second direction is the forward direction and the rearward direction, so as to facilitate the unmanned aerial vehicle to perform flight tasks, return home and land. When the movable platform is an unmanned vehicle or a robot, the first direction is the downward direction, and the second direction is the front direction and the rear direction, so that the unmanned vehicle or robot can perform tasks, return home and avoid movement obstruction.
根据无人机的当前所处的运动模式,控制云台进入相应的云台模式可以包括:当无人机的当前所处的运动模式为第一运动模式时,确定云台进入增稳模式。且在确定之后,可以控制云台进入增稳模式。Controlling the gimbal to enter the corresponding gimbal mode according to the current movement mode of the drone may include: when the current movement mode of the drone is the first movement mode, determining that the gimbal enters the stabilization mode. And after the confirmation, you can control the gimbal to enter the stabilization mode.
示例性的,当可移动平台为无人机时,第一运动模式可以为P挡位或普通挡位。由于,在第一运动模式下,检测装置的使用状态使得可移动平台具有相对较慢的移动速度,可移动平台的运动参数的控制受用户的指令的影响较小(可移动平台的运动参数受定位装置以及检测装置部分影响),定位装置以及检测装置的使用状态使得可移动平台可以实现精确悬停(当可移动平台为飞行器时)以及稳定移动,此时,不便于用户体验可移动平台的第一人称视角体验,便于可移动平台拍摄稳定的图像(当可移动平台为飞行器时,便于航拍)及采集稳定的声音,因此,控制云台进入增稳模式。Exemplarily, when the movable platform is an unmanned aerial vehicle, the first movement mode may be a P gear or a normal gear. Since, in the first motion mode, the use state of the detection device makes the movable platform have a relatively slow moving speed, the control of the motion parameters of the movable platform is less affected by the user's instructions (the motion parameters of the movable platform are affected by the user's instructions). The positioning device and the detection device are partially affected), the use state of the positioning device and the detection device enables the movable platform to achieve precise hovering (when the movable platform is an aircraft) and stable movement. At this time, it is inconvenient for users to experience the mobile platform The first-person perspective experience is convenient for the movable platform to shoot stable images (when the movable platform is an aircraft, it is convenient for aerial photography) and to collect stable sounds. Therefore, control the gimbal to enter the stabilization mode.
该多个运动模式可以包括第二运动模式,图5是根据本申请的一个实施例的可移动平台处于第二运动模式时的原理图。如图5所示,当可移动平台10处于第二运动模式时,定位装置400的使用状态为开启,检测装置500的使用状态为开启周围障碍物信息用于可移动平台10在第一方向上视觉避障的功能,并关闭周围障碍物信息用于可移动平台10在第二方向上视觉避障的功能。The plurality of motion modes may include a second motion mode, and FIG. 5 is a schematic diagram of the movable platform according to an embodiment of the present application when the movable platform is in the second motion mode. As shown in FIG. 5 , when the movable platform 10 is in the second motion mode, the use state of the positioning device 400 is turned on, and the use state of the detection device 500 is to turn on the surrounding obstacle information for the movable platform 10 in the first direction The function of visual obstacle avoidance is disabled, and the surrounding obstacle information is used for the visual obstacle avoidance function of the movable platform 10 in the second direction.
可以理解地,关闭周围障碍物信息用于可移动平台10在第二方向上视觉避障的功能可以包括:不检测可移动平台10在第二方向上周围障碍物信息,或,检测可移动平台10在第二方向上周围障碍物信息,但检测到的信息不用于可移动平台10在第二方向上的视觉避障。It can be understood that the function of disabling the surrounding obstacle information for visual obstacle avoidance of the movable platform 10 in the second direction may include: not detecting the surrounding obstacle information of the movable platform 10 in the second direction, or detecting the movable platform 10 surrounding obstacle information in the second direction, but the detected information is not used for visual obstacle avoidance of the movable platform 10 in the second direction.
在一些实施例中,当可移动平台处于第二运动模式时相比于处于第一运动模式时,可以具有较大的水平移动速度,由此,第二运动模式相比于第一运动模式更加适合一些有操作可移动平台的经验的用户。具体的速度可以根据实际情况选择,例如,当可移动平台处于第二运动模式时,其水平移动速度可以为17m/s至23m/s,例如,可以为17m/s、17.5m/s、18m/s、18.5m/s、19m/s、19.5m/s、20m/s、20.5m/s、21m/s、21.5m/s、22m/s、22.5m/s、23m/s等。当可移动平台处于第一运动模式时,其水平移动速度可以为12m/s至16m/s,例如,可以为12m/s、12.5m/s、13m/s、13.5m/s、14m/s、14.5m/s、15m/s、15.5m/s、16m/s等。In some embodiments, when the movable platform is in the second motion mode, it may have a larger horizontal movement speed than when it is in the first motion mode, whereby the second motion mode is more efficient than the first motion mode Suitable for some users who have experience with mobile platforms. The specific speed can be selected according to the actual situation. For example, when the movable platform is in the second motion mode, its horizontal movement speed can be 17m/s to 23m/s, for example, it can be 17m/s, 17.5m/s, 18m /s, 18.5m/s, 19m/s, 19.5m/s, 20m/s, 20.5m/s, 21m/s, 21.5m/s, 22m/s, 22.5m/s, 23m/s, etc. When the movable platform is in the first movement mode, its horizontal movement speed may be 12m/s to 16m/s, for example, it may be 12m/s, 12.5m/s, 13m/s, 13.5m/s, 14m/s , 14.5m/s, 15m/s, 15.5m/s, 16m/s, etc.
当可移动平台处于第二运动模式,且可移动平台为无人机时,可移动平台的最大上升速度以及最大下降速度可以根据实际情况选择,例如,最大上升速度可以为12m/s至16m/s,例如,可以为12m/s、12.5m/s、13m/s、13.5m/s、14m/s、14.5m/s、15m/s、15.5m/s、16m/s等。最大下降速度可以为8m/s至12m/s,例如,可以为8m/s、8.5m/s、9m/s、9.5m/s、10m/s、10.5m/s、11m/s、11.5m/s、12m/s等。When the movable platform is in the second motion mode and the movable platform is a drone, the maximum ascending speed and the maximum descending speed of the movable platform can be selected according to the actual situation, for example, the maximum ascending speed can be 12m/s to 16m/ s, for example, may be 12m/s, 12.5m/s, 13m/s, 13.5m/s, 14m/s, 14.5m/s, 15m/s, 15.5m/s, 16m/s, and the like. The maximum descending speed can be 8m/s to 12m/s, for example, it can be 8m/s, 8.5m/s, 9m/s, 9.5m/s, 10m/s, 10.5m/s, 11m/s, 11.5m /s, 12m/s, etc.
根据无人机的当前所处的运动模式,控制云台进入相应的云台模式可以包括:当无人机的当前所处的运动模式为第二运动模式时,控制云台进入增稳模式。且在确定之后,可以控制云台进入增稳模式。Controlling the gimbal to enter the corresponding gimbal mode according to the current movement mode of the drone may include: when the current movement mode of the drone is the second movement mode, controlling the gimbal to enter the stabilization mode. And after the confirmation, you can control the gimbal to enter the stabilization mode.
示例性的,当可移动平台为无人机时,第二运动模式可以为S挡位或运动模式。由于,在第二运动模式下,检测装置的使用状态使得可移动平台具有相对较慢的移动速度,可移动平台的运动参数的控制受用户的指令的影响较小(可移动平台的运动参数受定位装置以及检测装置部分影响),定位装置以及检测装置的使用状态使得可移动平台可以实现悬停(当可移动平台为飞行器时)以及稳定移动,此时,不便于用户体验可移动平台的第一人称视角体验,便于可移动平台拍摄稳定的图像(当可移动平台为飞行器时,便于航拍)及采集稳定的声音,因此,控制云台进入增稳模式。Exemplarily, when the movable platform is a drone, the second movement mode may be the S gear or the movement mode. Since, in the second motion mode, the use state of the detection device causes the movable platform to have a relatively slow moving speed, the control of the motion parameters of the movable platform is less affected by the user's instructions (the motion parameters of the movable platform are affected by the user's instructions). The positioning device and the detection device are partially affected), the use status of the positioning device and the detection device enables the movable platform to hover (when the movable platform is an aircraft) and move stably. At this time, it is not convenient for users to experience the first step of the movable platform. The one-person perspective experience is convenient for the movable platform to shoot stable images (when the movable platform is an aircraft, it is convenient for aerial photography) and to collect stable sounds. Therefore, control the gimbal to enter the stabilization mode.
该多个运动模式可以包括第三运动模式,图6是根据本申请的一个实施例的可移动平台处于第三运动模式时的原理图。如图6所示,当可移动平台处于第三运动模式时,定位装置的使用状态为关闭位置信息用于控制可移动平台的位置的功能,检测装置的使用状态为关闭周围障碍物信息用于可移动平台在第一方向以及第二方向上视觉避障的功能。The plurality of motion modes may include a third motion mode, and FIG. 6 is a schematic diagram of the movable platform according to an embodiment of the present application when the movable platform is in the third motion mode. As shown in FIG. 6 , when the movable platform is in the third motion mode, the use state of the positioning device is to close the function of position information for controlling the position of the movable platform, and the use state of the detection device is to close the surrounding obstacle information for use in The visual obstacle avoidance function of the movable platform in the first direction and the second direction.
定位装置的使用状态为关闭位置信息用于控制可移动平台的位置的功能可以包括:定位装置不用于获取可移动平台的位置信息,或,定位装置用于获取可移动平台的位置信息,但位置信息不用于控制可移动平台的位置。The use state of the positioning device is that the function of the position information used to control the position of the movable platform may include: the positioning device is not used to obtain the position information of the movable platform, or the positioning device is used to obtain the position information of the movable platform, but the position The information is not used to control the position of the movable platform.
可以理解地,关闭周围障碍物信息用于可移动平台10在第一方向上视觉避障的功能可以包括:不检测可移动平台10在第一方向上周围障碍物信息,或,检测可移动平台10在第一方向上周围障碍物信息,但检测到的信息不用于可移动平台10在第一方向上的视觉避障。It can be understood that the function of disabling the surrounding obstacle information for visual obstacle avoidance of the movable platform 10 in the first direction may include: not detecting the surrounding obstacle information of the movable platform 10 in the first direction, or detecting the movable platform 10 surrounding obstacle information in the first direction, but the detected information is not used for visual obstacle avoidance of the movable platform 10 in the first direction.
根据无人机的当前所处的运动模式,控制云台进入相应的云台模式可以包括:当无人机的当前所处的运动模式为第三运动模式时,控制云台进入跟随模式。且在确定之后,可以控制云台进入增稳模式。Controlling the gimbal to enter the corresponding gimbal mode according to the current movement mode of the drone may include: when the current movement mode of the drone is the third movement mode, controlling the gimbal to enter the follow mode. And after the confirmation, you can control the gimbal to enter the stabilization mode.
示例性的,当可移动平台为无人机时,第三运动模式可以为A挡位或姿态挡位。由于,在第三运动模式下,检测装置的使用状态使得可移动平台具有相对较快的移动速度,可移动平台的运动参数的控制 受用户的指令的影响较大(可移动平台的运动参数不受定位装置以及检测装置的影响),定位装置以及检测装置的使用状态使得可移动平台难以实现悬停(当可移动平台为飞行器时)以及稳定移动,此时,便于用户体验可移动平台的第一人称视角体验,不便于可移动平台拍摄稳定的图像(当可移动平台为飞行器时,不便于航拍)及采集稳定的声音,因此,控制云台进入跟随模式。Exemplarily, when the movable platform is an unmanned aerial vehicle, the third movement mode may be the A gear or the attitude gear. Because, in the third motion mode, the use state of the detection device makes the movable platform have a relatively fast moving speed, and the control of the motion parameters of the movable platform is greatly affected by the user's instructions (the motion parameters of the movable platform are not Influenced by the positioning device and the detection device), the use state of the positioning device and the detection device makes it difficult for the movable platform to hover (when the movable platform is an aircraft) and move stably. At this time, it is convenient for users to experience the first step of the movable platform. The one-person perspective experience is not convenient for the movable platform to shoot stable images (when the movable platform is an aircraft, it is not convenient for aerial photography) and to collect stable sounds. Therefore, control the gimbal to enter the follow mode.
在一些实施例中,当定位装置无法检测可移动平台的位置,且,检测装置无法检测可移动平台的周围障碍物信息时,控制可移动平台处于第三运动模式。In some embodiments, when the positioning device cannot detect the position of the movable platform, and the detection device cannot detect the surrounding obstacle information of the movable platform, the movable platform is controlled to be in the third motion mode.
在控制云台进入跟随模式之前,本实施例提供的控制方法还可以包括:判断可移动平台处于第三运动模式的原因;当判断的结果指示可移动平台处于第三运动模式的原因是响应于用户的输入指令时,则触发控制云台进入跟随模式的步骤。Before controlling the PTZ to enter the follow mode, the control method provided by this embodiment may further include: judging the reason why the movable platform is in the third motion mode; when the result of the judgment indicates that the reason why the movable platform is in the third motion mode is in response to When the user inputs an instruction, the step of controlling the PTZ to enter the follow mode is triggered.
图7是根据本申请的一个实施例的可移动平台响应于用户输入指令而处于第三运动模式的原理图。图7以可移动平台处于第三运动模式前是处于第一运动模式为例,可以理解地,在可移动平台处于第三运动模式前,可移动平台也可以处于其他运动模式,例如,第二运动模式或后文所提到的第四运动模式等。其中,用户可以通过各种方式输入指令,例如通过可移动平台的遥控器、智能终端等。FIG. 7 is a schematic diagram of a movable platform in a third motion mode in response to user input instructions, according to one embodiment of the present application. Fig. 7 takes the movable platform in the first movement mode before being in the third movement mode as an example. It can be understood that before the movable platform is in the third movement mode, the movable platform can also be in other movement modes, for example, the second movement mode. Sports mode or the fourth sports mode mentioned later, etc. Among them, the user can input instructions in various ways, for example, through a remote control of a movable platform, a smart terminal, and the like.
当判断的结果指示可移动平台处于第三运动模式的原因是响应于用户的输入指令时,表示用户期望可移动平台处于第三运动模式,而第三运动模式不便于可移动平台拍摄稳定的图像(当可移动平台为飞行器时,不便于航拍)及采集稳定的声音,便于用户对可移动平台的第一人称视角移动的体验,此时触发控制云台进入跟随模式的步骤可以满足用户的期望。When the result of the judgment indicates that the movable platform is in the third motion mode in response to the user's input instruction, it means that the user expects the movable platform to be in the third motion mode, and the third motion mode is inconvenient for the movable platform to capture stable images (When the movable platform is an aircraft, it is inconvenient for aerial photography) and stable sound collection is convenient for users to experience the movement of the movable platform in the first-person perspective. At this time, the steps of triggering and controlling the gimbal to enter the follow mode can meet the user's expectations.
当判断的结果指示可移动平台处于第三运动模式的原因是可移动平台由上一运动模式自动切换到第三运动模式时,维持云台处于上一运动模式对应的增稳模式或跟随模式。When the judgment result indicates that the movable platform is in the third motion mode because the movable platform is automatically switched from the last motion mode to the third motion mode, keep the gimbal in the stabilization mode or follow mode corresponding to the last motion mode.
例如,可移动平台由第一运动模式自动切换到第三运动模式时,维持云台处于增稳模式,可移动平台由第二运动模式自动切换到第三 运动模式时,维持云台处于增稳模式,可移动平台由后文提到的第四运动模式自动切换到第三运动模式时,维持云台处于跟随模式。此时,使得云台所处的模式更加符合用户的期望。For example, when the movable platform is automatically switched from the first motion mode to the third motion mode, keep the gimbal in the stabilization mode, and when the movable platform is automatically switched from the second motion mode to the third motion mode, keep the gimbal in the stabilization mode mode, when the movable platform is automatically switched from the fourth movement mode mentioned later to the third movement mode, the gimbal is maintained in the follow mode. At this time, the mode in which the PTZ is located is more in line with the user's expectation.
可移动平台由上一运动模式自动切换到第三运动模式的触发条件可以包括全球定位系统以及视觉定位系统的检测信息的可靠性降低。The triggering condition for the movable platform to automatically switch from the previous motion mode to the third motion mode may include a decrease in reliability of detection information of the global positioning system and the visual positioning system.
在一些实施例中,当全球定位系统的信号低于预设信号阈值时,确定全球定位系统的检测信息的可靠性降低。在另一些实施例中,可以在全球定位系统的指南针受到干扰时,确定全球定位系统的检测信息的可靠性降低。当可移动平台周围的光照低于预设亮度阈值时,确定视觉定位系统的检测信息的可靠性降低。In some embodiments, the reliability of determining the detection information of the GPS is reduced when the signal of the GPS is below a preset signal threshold. In other embodiments, the reliability of determining the detection information of the GPS may be reduced when the compass of the GPS is disturbed. When the illumination around the movable platform is lower than the preset brightness threshold, the reliability of determining the detection information of the visual positioning system is reduced.
在一些实施例中,预设信号阈值的设置可以使得当全球定位系统的信号低于预设信号阈值时,全球定位系统无法获取可移动平台的位置信息,预设亮度阈值可以使得当可移动平台周围的光照低于预设亮度阈值时,视觉定位系统无法获取可移动平台的周围障碍物信息。In some embodiments, the preset signal threshold can be set such that when the signal of the GPS is lower than the preset signal threshold, the GPS cannot obtain the position information of the movable platform, and the preset brightness threshold can be set such that when the movable platform is When the surrounding light is lower than the preset brightness threshold, the visual positioning system cannot obtain the surrounding obstacle information of the movable platform.
该多个运动模式包括第四运动模式,图8是根据本申请的一个实施例的可移动平台处于第四运动模式时的原理图,当可移动平台处于第四运动模式时,定位装置的使用状态为开启,且,检测装置的使用状态为关闭周围障碍物信息用于可移动平台在第一方向以及第二方向上视觉避障的功能。The plurality of motion modes include a fourth motion mode. FIG. 8 is a schematic diagram of the movable platform when the movable platform is in the fourth motion mode according to an embodiment of the present application. When the movable platform is in the fourth motion mode, the use of the positioning device The state is on, and the use state of the detection device is to turn off the function of the surrounding obstacle information for visual obstacle avoidance of the movable platform in the first direction and the second direction.
当可移动平台处于第四运动模式时,其水平移动速度可以为25m/s至30m/s,例如,可以为25m/s、25.5m/s、26m/s、26.5m/s、27m/s、27.5m/s、28m/s、28.5m/s、29m/s、29.5m/s、30m/s等。When the movable platform is in the fourth motion mode, its horizontal movement speed may be 25m/s to 30m/s, for example, it may be 25m/s, 25.5m/s, 26m/s, 26.5m/s, 27m/s , 27.5m/s, 28m/s, 28.5m/s, 29m/s, 29.5m/s, 30m/s, etc.
根据无人机的当前所处的运动模式,控制云台进入相应的云台模式可以包括:当无人机的当前所处的运动模式为第四运动模式时,控制云台进入跟随模式。且在确定之后,可以控制云台进入跟随模式。Controlling the gimbal to enter the corresponding gimbal mode according to the current movement mode of the drone may include: when the current movement mode of the drone is the fourth movement mode, controlling the gimbal to enter the follow mode. And after confirmation, you can control the gimbal to enter the follow mode.
示例性的,当可移动平台为无人机时,第四运动模式可以为M挡位或手动挡位。由于,在第四运动模式下,检测装置的使用状态使得可移动平台具有相对较快的移动速度,可移动平台的运动参数的控制受用户的指令的影响较大(可移动平台的运动参数受定位装置以及检 测装置的影响小),检测装置的使用状态使得可移动平台难以实现精确悬停(当可移动平台为飞行器时)以及稳定移动,此时,便于用户体验可移动平台的第一人称视角体验,不便于可移动平台拍摄稳定的图像(当可移动平台为飞行器时,不便于航拍)及采集稳定的声音,因此,控制云台进入跟随模式。Exemplarily, when the movable platform is an unmanned aerial vehicle, the fourth movement mode may be the M gear or the manual gear. Because, in the fourth motion mode, the use state of the detection device makes the movable platform have a relatively fast moving speed, and the control of the motion parameters of the movable platform is greatly affected by the user's instructions (the motion parameters of the movable platform are affected by the user's instructions). The influence of the positioning device and the detection device is small), the use state of the detection device makes it difficult for the movable platform to achieve precise hovering (when the movable platform is an aircraft) and stable movement. At this time, it is convenient for the user to experience the first-person perspective of the movable platform. Experience, it is not convenient for the movable platform to take stable images (when the movable platform is an aircraft, it is not convenient for aerial photography) and to collect stable sounds, therefore, control the gimbal to enter the follow mode.
可以理解地,针对不同的可移动平台,运动模式的相关设计可以有所变化,在一些实施例中,可移动平台的运动模式的数量可以为4种以外的其他数量,例如,可以为2种、3种、5种、6种、7种、8种、9种、10种等,并且,当运动模式的数量为4种时,各运动模式中定位装置和/或检测装置的使用状态也可以不限于上述实施例提供使用状态。相应地,各种运动模式与增稳模式以及跟随模式的对应关系也可以有所变化,可以不限于上述实施例提供的对应关系。It can be understood that for different movable platforms, the relevant design of the motion modes may vary. In some embodiments, the number of motion modes of the movable platform may be other than 4, for example, it may be 2 , 3 types, 5 types, 6 types, 7 types, 8 types, 9 types, 10 types, etc., and, when the number of motion modes is 4, the use status of the positioning device and/or the detection device in each motion mode is also The usage state may be provided without being limited to the above-described embodiment. Correspondingly, the corresponding relationship between the various motion modes, the stabilization mode, and the following mode may also be changed, and may not be limited to the corresponding relationship provided in the foregoing embodiment.
本申请提供的可移动平台的控制方法还可以包括:在可移动平台根据预设控制指令执行运动操作时,控制云台为增稳模式。由此,在可移动平台在执行这些运动操作,且负载为成像装置时,可以稳定成像,在可移动平台在执行这些运动操作,且负载为麦克风时,可以稳定采集周围声音,从而使得云台的模式更加适配这些运动操作。The control method for the movable platform provided by the present application may further include: when the movable platform performs a motion operation according to a preset control instruction, controlling the pan/tilt head to be in a stabilization mode. Therefore, when the movable platform is performing these motion operations and the load is an imaging device, the imaging can be stably formed. When the movable platform is performing these motion operations and the load is a microphone, the surrounding sound can be collected stably, so that the pan/tilt head can be stably collected. The mode is more suitable for these motion operations.
在一些实施例中,在可移动平台根据预设控制指令执行运动操作的过程中停止触发检测可移动平台当前所处的运动模式的步骤。从而使得在可移动平台在执行这些运动操作的整个过程中,都具有适配的云台的模式。In some embodiments, the step of triggering and detecting the motion mode the movable platform is currently in is stopped during the process that the movable platform performs the motion operation according to the preset control instruction. Therefore, the movable platform has an adapted pan/tilt mode during the entire process of performing these motion operations.
当可移动平台为飞行器时,预设控制指令可以包括返航指令或降落指令,由此,便于用户在返航或降落时掌握与可移动平台相关的信息,避免发生撞击等事故。例如,当负载为成像装置时,可以提供与返航或降落有关的稳定的图像,用户可以根据这些图像来操作飞行器,从而避免发生事故,提升用户体验。When the movable platform is an aircraft, the preset control command may include a return-to-home command or a landing command, thereby facilitating the user to grasp the information related to the movable platform when returning to home or landing to avoid accidents such as collisions. For example, when the payload is an imaging device, stable images related to returning to flight or landing can be provided, and the user can operate the aircraft according to these images, thereby avoiding accidents and improving user experience.
当可移动平台为无人车或机器人等时,预设控制指令可以包括返航指令,由此,便于用户在返航时掌握与可移动平台相关的信息,避免发生撞击等事故。例如,当负载为成像装置时,可以提供与返航有关的稳定的图像,用户可以根据这些图像来操作可移动平台,从而避 免发生事故,提升用户体验。When the movable platform is an unmanned vehicle or a robot, etc., the preset control command may include a return-to-home command, thereby facilitating the user to grasp the information related to the movable platform when returning to the home, and to avoid accidents such as collisions. For example, when the payload is an imaging device, it can provide stable images related to returning home, and the user can operate the movable platform according to these images, thereby avoiding accidents and improving user experience.
可以理解地,返航指令或降落指令可以由用户发出,也可以是可移动平台自行获取,例如,当可移动平台的电量不足时,可以自行获取返航指令或降落指令。It can be understood that the return-to-home command or the landing command can be issued by the user, or can be obtained by the movable platform itself. For example, when the battery of the movable platform is insufficient, the return-to-home command or the landing command can be obtained by itself.
本申请实施例提供的控制方法还可以包括:在可移动平台开机时,控制云台进入跟随模式。可以理解地,云台可以设置有限制其转动角度的限位结构,由于,可移动平台在开机时,其放置的位置较为多样化,例如,可以与正常使用状态颠倒等,若在开机时控制云台进入增稳模式,可能会发生撞限位的风险,从而可能导致限位结构损坏,因此,在开机时,控制云台进入跟随模式。The control method provided by the embodiment of the present application may further include: when the movable platform is powered on, controlling the PTZ to enter a follow mode. It can be understood that the gimbal can be provided with a limit structure that limits its rotation angle, because the movable platform is placed in various positions when it is turned on. For example, it can be reversed from the normal use state. When the gimbal enters the stabilization mode, there may be a risk of hitting the limit, which may cause damage to the limit structure. Therefore, when the gimbal is turned on, control the gimbal to enter the follow mode.
在一些实施例中,在可移动平台开机时至满足设定条件时的过程中停止触发检测可移动平台当前所处的运动模式的步骤。也就是说,在可移动平台开机时至满足设定条件时的过程中,云台都处于跟随模式,从而避免这段时间发生撞限位的风险。In some embodiments, the step of triggering and detecting the motion mode that the movable platform is currently in is stopped during the period from when the movable platform is powered on to when the set condition is satisfied. That is to say, from the time when the movable platform is turned on to when the set conditions are met, the gimbal is in the following mode, so as to avoid the risk of hitting the limit during this period.
设定条件可以包括可移动平台开机后的时长达到时长阈值,可移动平台开机,说明用户期望在开机一段时间后操作可移动平台,因此,会在开机一段时间后调整可移动平台的位置至正常使用状态的位置。因此,设定条件可以包括可移动平台开机后的时长达到时长阈值。该时长阈值可以根据实际情况确定,例如,可以为1s、2s、3s、4s、5s、6s、7s、9s、10s、20s、30s、40s、50s、60s等。The setting conditions can include that the time after the mobile platform is turned on reaches the time threshold, and the mobile platform is turned on, indicating that the user expects to operate the mobile platform after a period of time. Therefore, the position of the mobile platform will be adjusted to normal after a period of time. Where to use the state. Therefore, the set condition may include that the time period after the movable platform is powered on reaches the time period threshold. The duration threshold may be determined according to the actual situation, for example, may be 1s, 2s, 3s, 4s, 5s, 6s, 7s, 9s, 10s, 20s, 30s, 40s, 50s, 60s, etc.
设定条件可以包括可移动平台获取到运动模式的选择指令,获取到运动模式的选择指令,表示用户可以操作可移动平台的移动了,而用户操作可移动平台需要调整可移动平台的位置至正常使用状态的位置,因此,设定条件可以包括可移动平台获取到运动模式的选择指令。The setting conditions can include that the movable platform obtains the selection instruction of the motion mode, and the acquisition of the selection instruction of the motion mode indicates that the user can operate the movement of the movable platform, and the user needs to adjust the position of the movable platform to normal when operating the movable platform. Using the position of the state, therefore, the setting condition may include the movable platform acquiring the motion mode selection instruction.
当可移动平台为飞行器时,设定条件还可以包括可移动平台的高度处于高度阈值,此时,说明可移动平台已经处于飞行状态,此时,可移动平台已经处于正常的使用状态了,可以触发检测可移动平台当前所处的运动模式的步骤,以使得云台对负载姿态的控制方式可以适配可移动平台当前所处的运动模式,使得可移动平台在当前所处的运 动模式不同的情况下,云台对负载姿态的控制方式都能满足不同运动模式的需求。When the movable platform is an aircraft, the setting condition may also include that the height of the movable platform is at the height threshold. At this time, it means that the movable platform is already in the flying state. Trigger the step of detecting the motion mode that the movable platform is currently in, so that the control method of the gimbal on the load attitude can be adapted to the motion mode that the movable platform is currently in, so that the movable platform is currently in a different motion mode. Under the circumstance, the control method of the gimbal to the load attitude can meet the needs of different motion modes.
本实施例提供的控制方法,当云台由跟随模式进入增稳模式时还可以包括:控制增稳模式下负载的测量对地姿态为跟随模式下负载与支撑机构的目标相对姿态角对应的目标对地姿态。In the control method provided in this embodiment, when the gimbal enters the stabilization mode from the follow mode, the method may further include: controlling the measured attitude of the load to the ground in the stabilization mode to be the target corresponding to the target relative attitude angle of the load and the support mechanism in the follow mode Ground stance.
图9是根据本申请的一个实施例的可移动平台的云台由跟随模式进入增稳模式时的原理图。可以理解地,图9表示的状态为云台由跟随模式进入增稳模式的时刻,此时负载100与支撑机构300的目标相对姿态角可以为图9中所示的角α,与角α对应的目标对地姿态可以由角β表示,则在云台由跟随模式进入增稳模式的时刻,直接将角β表示的目标对地姿态赋值给增稳模式下负载100的测量对地姿态,即此时测量对地姿态是直接赋值的,而不是测量得到的,由此,在这个时刻,云台的位置相对稳定,不会发生抖动,当负载100为成像装置时,可以使得成像装置拍出的画面稳定,不发生抽动,并且云台的电机的力矩也不会发生突变。FIG. 9 is a schematic diagram when the gimbal of the movable platform enters the stabilization mode from the follow mode according to an embodiment of the present application. It can be understood that the state shown in FIG. 9 is the moment when the gimbal enters the stabilization mode from the follow mode. At this time, the target relative attitude angle of the load 100 and the support mechanism 300 can be the angle α shown in FIG. 9 , which corresponds to the angle α. The target ground attitude can be represented by the angle β, then when the gimbal enters the stabilization mode from the follow mode, the target ground attitude represented by the angle β is directly assigned to the measured ground attitude of the load 100 in the stabilization mode, that is At this time, the measurement of the attitude to the ground is directly assigned, not obtained by measurement. Therefore, at this moment, the position of the gimbal is relatively stable and does not vibrate. When the load 100 is an imaging device, the imaging device can take pictures. The picture is stable, no twitching occurs, and the torque of the gimbal's motor will not change abruptly.
可以理解地,上述对测量对地姿态直接赋值可以仅在云台由跟随模式进入增稳模式的时刻,而后,测量对地姿态可以是实时测量得到的,并且,用户也可以根据需要调整增稳模式的目标对地姿态。It can be understood that the above-mentioned direct assignment of the measured ground attitude can only be performed at the moment when the gimbal enters the stabilization mode from the follow mode, and then the measured ground attitude can be obtained by real-time measurement, and the user can also adjust the stabilization as needed. The target ground attitude of the mode.
本实施例提供的控制方法,当云台由增稳模式进入跟随模式时还可以包括:控制跟随模式下负载与支撑机构的测量相对姿态角为增稳模式下负载的目标对地姿态对应的目标相对姿态角。In the control method provided in this embodiment, when the gimbal enters the following mode from the stabilization mode, it may further include: controlling the measured relative attitude angle of the load and the support mechanism in the following mode to be the target corresponding to the ground attitude of the load in the stabilization mode Relative attitude angle.
图10是根据本申请的一个实施例的可移动平台的云台由增稳模式进入跟随模式时的原理图。可以理解地,图10表示的状态为云台由增稳模式进入跟随模式的时刻,此时负载的目标对地姿态可以由图10中的角γ表示,与角γ对应的目标相对姿态角为角θ,则在云台由增稳模式进入跟随模式的时刻,直接将角θ赋值给跟随模式下负载100的测量相对姿态角,即此时测量相对姿态角是直接赋值的,而不是测量得到的,由此,在这个时刻,云台的位置相对稳定,不会发生抖动,当负载100为成像装置时,可以使得成像装置拍出的画面稳定,不发生抽动,并且云台的电机的力矩也不会发生突变。FIG. 10 is a schematic diagram when the gimbal of the movable platform enters the follow mode from the stabilization mode according to an embodiment of the present application. It can be understood that the state shown in Figure 10 is the moment when the gimbal enters the follow mode from the stabilization mode. At this time, the target attitude of the load to the ground can be represented by the angle γ in Figure 10, and the relative attitude angle of the target corresponding to the angle γ is angle θ, when the gimbal enters the follow mode from the stabilization mode, the angle θ is directly assigned to the measured relative attitude angle of the load 100 in the follow mode, that is, the measured relative attitude angle is directly assigned, not measured. Therefore, at this moment, the position of the gimbal is relatively stable and will not shake. When the load 100 is an imaging device, the image taken by the imaging device can be stabilized without twitching, and the torque of the motor of the gimbal can be stabilized. Mutation does not occur.
可以理解地,上述对测量相对姿态角直接赋值可以仅在云台由增稳模式进入跟随模式的时刻,而后,测量相对姿态角可以是实时测量得到的,并且,用户也可以根据需要调整跟随模式的目标相对姿态角,也就是说,即使在可移动平台移动时,用户也可以根据需求调整目标相对姿态角,以满足用户的期望。It can be understood that the above-mentioned direct assignment of the measured relative attitude angle can only be performed at the moment when the gimbal enters the follow mode from the stabilization mode, and then the measured relative attitude angle can be obtained by real-time measurement, and the user can also adjust the follow mode as required. The target relative attitude angle of , that is, even when the movable platform moves, the user can adjust the target relative attitude angle according to the needs to meet the user's expectations.
图11是根据本申请的一个实施例的可移动平台的云台处于增稳模式时的控制原理图。如图11所示,云台处于增稳模式时控制方法还可以包括:确定负载的对地目标姿态角Ra;获取负载的对地测量姿态角ya;根据对地目标姿态角Ra以及对地测量姿态角ya控制云台,以保持负载对地姿态稳定。对地测量姿态角ya可以通过可以测量单元获得,例如惯性测量单元、电子加速计及陀螺仪等,还可以由融合姿态估计器FUS经过姿态融合得到。FIG. 11 is a control principle diagram when the gimbal of the movable platform is in the stabilization mode according to an embodiment of the present application. As shown in FIG. 11 , when the gimbal is in the stabilization mode, the control method may further include: determining the ground target attitude angle Ra of the load; obtaining the ground measurement attitude angle ya of the load; according to the ground target attitude angle Ra and the ground measurement The attitude angle ya controls the gimbal to keep the load-to-ground attitude stable. The ground measurement attitude angle ya can be obtained by measuring units, such as inertial measurement units, electronic accelerometers and gyroscopes, etc., and can also be obtained by fusion attitude estimator FUS through attitude fusion.
根据对地目标姿态角Ra以及对地测量姿态角ya控制云台,以保持负载对地姿态稳定可以包括:根据对地目标姿态角Ra以及对地测量姿态角ya确定负载的对地目标角速度;获取负载的对地测量角速度
Figure PCTCN2020139528-appb-000001
根据对地目标角速度以及对地测量角速度
Figure PCTCN2020139528-appb-000002
确定云台的电机的控制力矩u;根据控制力矩u控制云台200的电机,以保持负载对地姿态稳定。对地测量角速度
Figure PCTCN2020139528-appb-000003
可以通过可以测量单元获得,例如惯性测量单元、电子加速计及陀螺仪等,还可以由融合姿态估计器FUS经过姿态融合得到。
Controlling the gimbal according to the ground target attitude angle Ra and the ground measurement attitude angle ya to keep the load’s ground attitude stable may include: determining the load’s ground target angular velocity according to the ground target attitude angle Ra and the ground measurement attitude angle ya; Get the ground-measured angular velocity of the load
Figure PCTCN2020139528-appb-000001
According to the angular velocity of the ground target and the measured angular velocity of the ground
Figure PCTCN2020139528-appb-000002
Determine the control torque u of the motor of the gimbal; control the motor of the gimbal 200 according to the control torque u, so as to keep the attitude of the load to the ground stable. Measuring angular velocity over the ground
Figure PCTCN2020139528-appb-000003
It can be obtained by measuring units, such as inertial measurement units, electronic accelerometers and gyroscopes, etc., and can also be obtained by fusion attitude estimator FUS through attitude fusion.
其中,根据对地目标姿态角Ra以及对地测量姿态角ya确定负载的对地目标角速度可以包括:根据对地目标姿态角Ra以及对地测量姿态角ya确定误差e(此时,表示负载的姿态误差),然后通过姿态角度环控制器C1确定负载的对地目标角速度。Wherein, determining the ground target angular velocity of the load according to the ground target attitude angle Ra and the ground measurement attitude angle ya may include: determining the error e according to the ground target attitude angle Ra and the ground measurement attitude angle ya (at this time, representing the load Attitude error), and then determine the ground target angular velocity of the load through the attitude angle loop controller C1.
根据对地目标角速度以及对地测量角速度
Figure PCTCN2020139528-appb-000004
确定云台的电机的控制力矩可以包括:获取云台受到的外部扰动d,外部扰动d能够使得云台的位置和/或姿态发生变化;根据对地目标角速度、对地测量角速度
Figure PCTCN2020139528-appb-000005
以及外部扰动d(干扰力矩)确定控制力矩u。
According to the angular velocity of the ground target and the measured angular velocity of the ground
Figure PCTCN2020139528-appb-000004
Determining the control torque of the motor of the gimbal may include: acquiring the external disturbance d received by the gimbal, and the external disturbance d can cause the position and/or attitude of the gimbal to change; according to the target angular velocity to the ground, the angular velocity measured to the ground
Figure PCTCN2020139528-appb-000005
And the external disturbance d (disturbance torque) determines the control torque u.
具体地,根据对地目标角速度、对地测量角速度
Figure PCTCN2020139528-appb-000006
以及姿态角速度环控制器C2得到待修正力矩,根据待修正力矩以及外部扰动d 确定控制力矩u。
Specifically, according to the ground target angular velocity, the ground measurement angular velocity
Figure PCTCN2020139528-appb-000006
And the attitude angular velocity loop controller C2 obtains the to-be-corrected torque, and determines the control torque u according to the to-be-corrected torque and the external disturbance d.
其中,可以基于与负载连接的云台的一个或多个运动特性来确定外部扰动d。外部扰动d可以与对云台的干扰相关联。例如,干扰可以包括风力影响、温度变化或对负载或云台的外部撞击中的一个或多个。云台的运动特性可以包括云台的瞬时姿态、瞬时位置、线速度、角速度、线加速度和/或角加速度。可以关于云台的框架(例如,航向框架)上的可旋转接头来计算外部扰动d,该可旋转接头被配置为将框架与支撑机构连接。Therein, the external disturbance d may be determined based on one or more motion characteristics of the pan/tilt head connected to the load. The external disturbance d can be associated with disturbance to the gimbal. For example, disturbances may include one or more of wind effects, temperature changes, or external impacts to the load or head. The motion characteristics of the gimbal may include the instantaneous attitude, instantaneous position, linear velocity, angular velocity, linear acceleration and/or angular acceleration of the gimbal. The external disturbance d can be calculated with respect to a rotatable joint on the frame of the head (eg, the heading frame), which is configured to connect the frame with the support mechanism.
可以由外部干扰传感器获得的传感器数据以获得外部扰动d的量。在一些实施例中,传感器数据被输入到云台和/或负载的动力学模型中,并且模型的输出是外部扰动d。Sensor data that can be obtained from the external disturbance sensor to obtain the amount of external disturbance d. In some embodiments, sensor data is input into a dynamic model of the gimbal and/or load, and the output of the model is the external disturbance d.
动力学模型可以包括与特定云台和/或负载的特定特性对应的参数。模型参数的确定和动力学模型的生成可以根据本领域技术人员已知的方法来确定。可以在操作之前确定动力学模型,并且可以将其预先存储在位于负载、云台和/或可移动物体上的存储器中。The kinetic model may include parameters corresponding to specific characteristics of a specific head and/or load. Determination of model parameters and generation of kinetic models can be determined according to methods known to those skilled in the art. The kinetic model may be determined prior to operation and may be pre-stored in memory located on the load, head and/or movable object.
例如,在一些实施例中,对于三轴云台,外框架(例如,航向框架)上的外部扰动d与将云台与支撑机构连接的减震元件的加速度之间的关系的数学模型是:For example, in some embodiments, for a three-axis gimbal, the mathematical model for the relationship between the external disturbance d on the outer frame (eg, the heading frame) and the acceleration of the shock-absorbing element connecting the gimbal to the support mechanism is:
Tdisturb=(K1sin(ψ)Tdisturb=(K1sin(ψ)
+K2cos(δ)cos(ψ))ax+(K3cos(ψ)+K2cos(δ)cos(ψ))ax+(K3cos(ψ)
+K4cos(δ)sin(ψ))ay+K4cos(δ)sin(ψ))ay
其中:Tdisturb是外框架的驱动器(例如,航向驱动器)上的外部扰动d;K1,K2,K3和K4是动力学模型的参数,基于三个云台框架的权重、旋转惯性张量和几何结构来确定这些参数;其中,ax和ay是减震元件分别在x(与竖直方向垂直的一方向)和y方向(与竖直方向垂直的另一方向,且与x方向垂直)上的加速度测量结果;以及ψ,δ是由与云台框架的驱动器连接的传感器(如电位计)测量的当前接头角度(例如,ψ是航向框架的航向驱动器的角度,而δ是横滚框架的横滚驱动器的角度)。where: Tdisturb is the external disturbance d on the drive of the outer frame (e.g. the heading drive); K1, K2, K3 and K4 are the parameters of the dynamics model, based on the weights, rotational inertia tensors and geometry of the three gimbal frames to determine these parameters; where ax and ay are the accelerations of the damping element in the x (a direction perpendicular to the vertical direction) and the y direction (the other direction perpendicular to the vertical direction and perpendicular to the x direction), respectively measurement results; and ψ, δ is the current joint angle measured by a sensor (such as a potentiometer) connected to the drive of the gimbal frame (e.g., ψ is the angle of the heading drive of the yaw frame, and δ is the roll of the roll frame angle of the drive).
增稳模式的作用是设计姿态角度环控制器C1、姿态角速度环控制器C2,使得在外部扰动d的作用下,尽可能地保证对地测量姿态角ya接近对地目标姿态角Ra,误差e尽可能地小,以保证负载的对地姿态稳定。The role of the stabilization mode is to design the attitude angle loop controller C1 and the attitude angular velocity loop controller C2, so that under the action of the external disturbance d, the ground measurement attitude angle ya is as close as possible to the ground target attitude angle Ra, and the error e is It should be as small as possible to ensure the stable attitude of the load to the ground.
图12是根据本申请的一个实施例的可移动平台的云台处于跟随模式时的控制原理图。如图12所示,云台处于跟随模式时控制方法还包括:确定负载与支撑机构的目标相对姿态角Rj;获取负载与支撑机构的测量相对姿态角yj;根据目标相对姿态角Rj以及测量相对姿态角yj控制云台,以保持负载与支撑机构的相对姿态稳定。FIG. 12 is a control principle diagram of the gimbal of the movable platform when it is in a follow mode according to an embodiment of the present application. As shown in FIG. 12 , when the pan/tilt head is in the following mode, the control method further includes: determining the target relative attitude angle Rj of the load and the support mechanism; obtaining the measured relative attitude angle yj of the load and the support mechanism; according to the target relative attitude angle Rj and the measured relative attitude angle Rj The attitude angle yj controls the gimbal to keep the relative attitude of the load and the support mechanism stable.
根据目标相对姿态角Rj以及测量相对姿态角yj控制云台,以保持负载与支撑机构的相对姿态稳定可以包括:根据目标相对姿态角Rj以及测量相对姿态角yj确定负载与支撑机构间的目标相对姿态角速度;获取负载与支撑机构间的测量相对姿态角速度
Figure PCTCN2020139528-appb-000007
根据目标相对姿态角速度以及测量相对姿态角速度
Figure PCTCN2020139528-appb-000008
确定云台200的电机的控制力矩u;根据控制力矩u控制电机,以保持负载与支撑机构的相对姿态稳定。
Controlling the gimbal according to the target relative attitude angle Rj and the measured relative attitude angle yj to keep the relative attitude of the load and the support mechanism stable may include: determining the target relative attitude between the load and the support mechanism according to the target relative attitude angle Rj and the measured relative attitude angle yj Attitude angular velocity; obtains the measured relative attitude angular velocity between the load and the support mechanism
Figure PCTCN2020139528-appb-000007
According to the target relative attitude angular velocity and the measured relative attitude angular velocity
Figure PCTCN2020139528-appb-000008
Determine the control torque u of the motor of the gimbal 200; control the motor according to the control torque u to keep the relative posture of the load and the support mechanism stable.
其中,测量相对姿态角速度
Figure PCTCN2020139528-appb-000009
可以直接测量得到,测量相对姿态角yj可以由测量相对姿态角速度
Figure PCTCN2020139528-appb-000010
通过积分过程1/S获得。
Among them, measure the relative attitude angular velocity
Figure PCTCN2020139528-appb-000009
It can be directly measured, and the relative attitude angle yj can be measured by measuring the relative attitude angular velocity
Figure PCTCN2020139528-appb-000010
Obtained through the integration process 1/S.
根据目标相对姿态角Rj以及测量相对姿态角yj确定负载与支撑机构间的目标相对姿态角速度可以包括:根据目标相对姿态角Rj以及测量相对姿态角yj确定误差e(此时,为关节角误差),然后通过关节角度环控制器C3确定目标相对姿态角速度。Determining the target relative attitude angular velocity between the load and the support mechanism according to the target relative attitude angle Rj and the measured relative attitude angle yj may include: determining the error e (in this case, the joint angle error) according to the target relative attitude angle Rj and the measured relative attitude angle yj , and then determine the target relative attitude angular velocity through the joint angle loop controller C3.
根据目标相对姿态角速度以及测量相对姿态角速度
Figure PCTCN2020139528-appb-000011
确定云台的电机的控制力矩可以包括:获取云台受到的外部扰动d,外部扰动d能够使得云台的位置和/或姿态发生变化;根据目标相对姿态角速度、测量相对姿态角速度
Figure PCTCN2020139528-appb-000012
以及外部扰动d确定控制力矩u。
According to the target relative attitude angular velocity and the measured relative attitude angular velocity
Figure PCTCN2020139528-appb-000011
Determining the control torque of the motor of the gimbal may include: acquiring the external disturbance d received by the gimbal, the external disturbance d can cause the position and/or attitude of the gimbal to change; according to the target relative attitude angular velocity, measure the relative attitude angular velocity
Figure PCTCN2020139528-appb-000012
And the external disturbance d determines the control torque u.
具体地,根据对地目标角速度、对地测量角速度
Figure PCTCN2020139528-appb-000013
以及关节角速度环控制器C4得到待修正力矩,根据待修正力矩以及外部扰动d确定控制力矩u。
Specifically, according to the ground target angular velocity, the ground measurement angular velocity
Figure PCTCN2020139528-appb-000013
And the joint angular velocity loop controller C4 obtains the torque to be corrected, and determines the control torque u according to the torque to be corrected and the external disturbance d.
也就是说,跟随模式的作用是,设计关节角度环控制器C3、关 节角速度环控制器C4,使得在外部扰动d的作用下,尽可能地保证测量相对姿态角yj接近目标相对姿态角Rj,误差e尽可能地小,以保证云台和支撑机构之间的相对夹角不变,云台紧紧跟随支撑机构的姿态调整姿态。That is to say, the role of the follow mode is to design the joint angle loop controller C3 and the joint angular velocity loop controller C4, so that under the action of the external disturbance d, the measured relative attitude angle yj is as close to the target relative attitude angle Rj as possible, The error e is as small as possible to ensure that the relative angle between the gimbal and the support mechanism remains unchanged, and the gimbal closely follows the attitude of the support mechanism to adjust the attitude.
图12所示的这种跟随模式的控制原理中,目标相对姿态角Rj不需要实时测量,使得需要测量的物理量少,仅仅需要测量相对姿态角速度
Figure PCTCN2020139528-appb-000014
由此,可以减少测量精度带来的误差,并且,使得可移动平台不需要启用较多的传感器,提升了用户的使用体验。
In the control principle of the following mode shown in Figure 12, the target relative attitude angle Rj does not need to be measured in real time, so that less physical quantities need to be measured, and only the relative attitude angular velocity needs to be measured
Figure PCTCN2020139528-appb-000014
Therefore, the error caused by the measurement accuracy can be reduced, and the movable platform does not need to activate more sensors, which improves the user experience.
图13是根据本申请的另一个实施例的可移动平台的云台处于跟随模式时的控制原理图。如图13所示,云台处于跟随模式时控制方法还包括:确定负载的对地目标姿态角Rfc;获取负载的对地测量姿态角ya;根据对地目标姿态角Rfc以及负载的对地测量姿态角ya控制云台,以保持负载与支撑机构的相对姿态稳定。其中,负载的对地目标姿态角Rfc可以由支撑机构的对地测量姿态角确定。对地测量姿态角ya可以通过可以测量单元获得,例如惯性测量单元、电子加速计及陀螺仪等,还可以由融合姿态估计器FUS经过姿态融合得到。FIG. 13 is a control principle diagram when the pan/tilt of the movable platform is in a follow mode according to another embodiment of the present application. As shown in FIG. 13 , when the gimbal is in the following mode, the control method further includes: determining the ground target attitude angle Rfc of the load; obtaining the ground measurement attitude angle ya of the load; according to the ground target attitude angle Rfc and the ground measurement of the load The attitude angle ya controls the gimbal to keep the relative attitude of the load and the support mechanism stable. Wherein, the ground target attitude angle Rfc of the load can be determined by the ground measurement attitude angle of the support mechanism. The ground measurement attitude angle ya can be obtained by measuring units, such as inertial measurement units, electronic accelerometers and gyroscopes, etc., and can also be obtained by fusion attitude estimator FUS through attitude fusion.
根据对地目标姿态角Rfc以及负载的对地测量姿态角ya控制云台,以保持负载与支撑机构的相对姿态稳定,包括:根据对地目标姿态角Rfc以及负载的对地测量姿态角ya确定负载的对地目标角速度;获取负载的对地测量角速度
Figure PCTCN2020139528-appb-000015
根据对地目标角速度以及对地测量角速度
Figure PCTCN2020139528-appb-000016
确定云台的电机的控制力矩u;根据控制力矩u控制电机,以保持负载与支撑机构的相对姿态稳定。对地测量角速度
Figure PCTCN2020139528-appb-000017
可以通过可以测量单元获得,例如惯性测量单元、电子加速计及陀螺仪等,还可以由融合姿态估计器FUS经过姿态融合得到。
Control the gimbal according to the ground target attitude angle Rfc and the load’s ground measurement attitude angle ya to keep the relative attitude of the load and the support mechanism stable, including: determining according to the ground target attitude angle Rfc and the load’s ground measurement attitude angle ya The ground target angular velocity of the load; obtain the measured ground angular velocity of the load
Figure PCTCN2020139528-appb-000015
According to the angular velocity of the ground target and the measured angular velocity of the ground
Figure PCTCN2020139528-appb-000016
Determine the control torque u of the motor of the gimbal; control the motor according to the control torque u to keep the relative posture of the load and the support mechanism stable. Measuring angular velocity over the ground
Figure PCTCN2020139528-appb-000017
It can be obtained by measuring units, such as inertial measurement units, electronic accelerometers and gyroscopes, etc., and can also be obtained by fusion attitude estimator FUS through attitude fusion.
根据对地目标姿态角Rfc以及负载的对地测量姿态角ya确定负载的对地目标角速度可以包括:根据对地目标姿态角Rfc以及负载的对地测量姿态角ya确定误差e(此时,为姿态误差),然后通过姿态角度环控制器C1确定负载的对地目标角速度。Determining the ground target angular velocity of the load according to the ground target attitude angle Rfc and the load’s ground measurement attitude angle ya may include: determining the error e according to the ground target attitude angle Rfc and the load’s ground measurement attitude angle ya (in this case, it is Attitude error), and then determine the ground target angular velocity of the load through the attitude angle loop controller C1.
根据对地目标角速度以及对地测量角速度
Figure PCTCN2020139528-appb-000018
确定云台的电机的控制力矩可以包括:获取云台受到的外部扰动d,外部扰动d能够使 得云台的位置和/或姿态发生变化;根据对地目标角速度、对地测量角速度
Figure PCTCN2020139528-appb-000019
以及外部扰动d确定控制力矩u。
According to the angular velocity of the ground target and the measured angular velocity of the ground
Figure PCTCN2020139528-appb-000018
Determining the control torque of the motor of the gimbal may include: acquiring the external disturbance d received by the gimbal, and the external disturbance d can cause the position and/or attitude of the gimbal to change; according to the target angular velocity to the ground, the angular velocity measured to the ground
Figure PCTCN2020139528-appb-000019
And the external disturbance d determines the control torque u.
具体地,根据对地目标角速度、对地测量角速度
Figure PCTCN2020139528-appb-000020
以及姿态角速度环控制器C2得到待修正力矩,根据待修正力矩以及外部扰动d确定控制力矩u。
Specifically, according to the ground target angular velocity, the ground measurement angular velocity
Figure PCTCN2020139528-appb-000020
And the attitude angular velocity loop controller C2 obtains the torque to be corrected, and determines the control torque u according to the torque to be corrected and the external disturbance d.
也就是说,跟随模式的作用是,设计姿态角度环控制器C1、姿态角速度环控制器C2,使得在外部扰动d的作用下,尽可能地保证对地目标姿态角Rfc接近对地测量姿态角ya,误差e尽可能地小,以保证云台和支撑机构之间的相对夹角不变,云台紧紧跟随支撑机构的姿态调整姿态。That is to say, the role of the following mode is to design the attitude angle loop controller C1 and the attitude angular velocity loop controller C2, so that under the action of the external disturbance d, the target attitude angle Rfc to the ground is as close as possible to the ground measurement attitude angle. ya, the error e is as small as possible to ensure that the relative angle between the gimbal and the support mechanism remains unchanged, and the gimbal closely follows the attitude of the support mechanism to adjust the attitude.
可以理解地,上述增稳模式以及跟随模式通过PID(Proportion Integration Differentiation,比例积分微分)算法实现,从而保证了控制的精度以及响应速度。也就是说,在增稳模式下,云台具有较强的增稳性能,即增稳时的控制精度高,同时,在跟随模式下,云台紧紧跟随支撑机构调整。It is understandable that the above-mentioned stabilization mode and following mode are implemented by a PID (Proportion Integration Differentiation, proportional integral derivative) algorithm, thereby ensuring the control accuracy and response speed. That is to say, in the stabilization mode, the gimbal has strong stabilization performance, that is, the control accuracy during stabilization is high. At the same time, in the follow mode, the gimbal closely follows the adjustment of the support mechanism.
图13所示的这种跟随模式的控制原理中,PID的控制框架与增稳模式类似,只是增稳模式的目标对地姿态不是实时测量的,而图13所示的跟随模式的目标对地姿态是实时测量的支撑机构的测量对地姿态。由此,在设计图13所示的这种跟随模式的PID时,仅需要对增稳模式的PID的控制框架进行较少的调整,减轻了可移动平台的生产人力成本。In the control principle of the following mode shown in Figure 13, the PID control framework is similar to the stabilization mode, except that the target-to-ground attitude of the stabilization mode is not measured in real time, while the target-to-ground attitude of the following mode shown in Figure 13 is not measured in real time. The attitude is the measured ground attitude of the support mechanism measured in real time. Therefore, when designing the PID in the following mode shown in FIG. 13 , only a few adjustments need to be made to the control framework of the PID in the stabilization mode, which reduces the production labor cost of the movable platform.
当可移动平台开机时,例如根据用户发出的开机指令开机时,云台会进入跟随模式。然后,可移动平台获取到运动模式的选择指令,并触发检测可移动平台当前所处的运动模式的步骤。选择指令可以指示用户期望可移动平台处于第一运动模式,则控制可移动平台处于第一运动模式,并使云台处于增稳模式。用户还可以发出选择指令,这次发出的选择指令可以指示用户期望可移动平台处于第二运动模式,则控制可移动平台处于第二运动模式,并使云台处于增稳模式。用户可以再次发出选择指令,再次发出的选择指令可以指示用户期望可移动平台处于第三运动模式,则控制可移动平台处于第三运动模式,此 时,可移动平台处于第三运动模式的原因是响应于用户的输入指令,则触发控制云台进入跟随模式的步骤。当云台由跟随模式进入增稳模式时,控制增稳模式下负载的测量对地姿态为跟随模式下负载与支撑机构的目标相对姿态角对应的目标对地姿态。用户可以又一次发出选择指令,又一次发出的选择指令可以指示用户期望可移动平台处于第四运动模式,则控制可移动平台处于第四运动模式,并使云台处于跟随模式。可移动平台继续移动,当全球定位系统以及视觉定位系统的检测信息的可靠性降低时,又会使可移动平台由第四运动模式自动切换到第三运动模式,此时,维持云台处于第四运动模式时对应的跟随模式。在可移动平台根据返航指令返航时,控制云台为增稳模式。当云台由跟随模式进入增稳模式时,控制增稳模式下负载的测量对地姿态为跟随模式下负载与支撑机构的目标相对姿态角对应的目标对地姿态。且在返航的过程中停止触发检测可移动平台当前所处的运动模式的步骤。当可移动平台为飞行器时,可移动平台还会根据降落指令降落,此时,控制云台为增稳模式,并在降落的过程中停止触发检测可移动平台当前所处的运动模式的步骤,直至可移动平台完成降落。When the movable platform is powered on, for example, when powered on according to the power-on command issued by the user, the gimbal will enter the follow mode. Then, the movable platform acquires the motion mode selection instruction, and triggers the step of detecting the motion mode currently in which the movable platform is located. The selection instruction may indicate that the user expects the movable platform to be in the first motion mode, then the movable platform is controlled to be in the first motion mode, and the gimbal is placed in the stabilization mode. The user can also issue a selection instruction, and the selection instruction issued this time can indicate that the user expects the movable platform to be in the second motion mode, then controls the movable platform to be in the second motion mode, and makes the gimbal in the stabilization mode. The user can issue a selection instruction again, and the reissued selection instruction can indicate that the user expects the movable platform to be in the third motion mode, and then controls the movable platform to be in the third motion mode. At this time, the reason why the movable platform is in the third motion mode is In response to the user's input instruction, the step of controlling the PTZ to enter the follow mode is triggered. When the gimbal enters the stabilization mode from the following mode, the measured ground attitude of the load in the control stabilization mode is the target ground attitude corresponding to the target relative attitude angle of the load and the support mechanism in the follow mode. The user can issue the selection instruction again, and the selection instruction issued again can indicate that the user expects the movable platform to be in the fourth motion mode, then controls the movable platform to be in the fourth motion mode, and makes the pan/tilt head in the follow mode. The movable platform continues to move. When the reliability of the detection information of the global positioning system and the visual positioning system decreases, the movable platform will automatically switch from the fourth motion mode to the third motion mode. At this time, keep the gimbal in the first motion mode. The corresponding follow mode when the four sports modes are used. When the movable platform returns to home according to the return-to-home command, the gimbal is controlled to be in stabilization mode. When the gimbal enters the stabilization mode from the following mode, the measured ground attitude of the load in the control stabilization mode is the target ground attitude corresponding to the target relative attitude angle of the load and the support mechanism in the follow mode. And in the process of returning home, the step of triggering and detecting the motion mode that the movable platform is currently in is stopped. When the movable platform is an aircraft, the movable platform will also land according to the landing command. At this time, the gimbal is controlled to be in the stabilization mode, and the step of triggering the detection of the current motion mode of the movable platform is stopped during the landing process. until the movable platform has landed.
本实施例还提供了一种计算机可读存储介质,计算机可读存储介质存储有可执行指令,可执行指令在由一个或多个处理器执行时,可以使一个或多个处理器执行上述任一可移动平台的控制方法。This embodiment also provides a computer-readable storage medium, where the computer-readable storage medium stores executable instructions, and when executed by one or more processors, the executable instructions can cause one or more processors to execute any of the above A control method of a movable platform.
其中计算机可读存储介质也可以被称为存储器,可执行指令又可以被称为程序。处理器可以根据存储在只读存储器(ROM)中的程序或者加载到随机访问存储器(RAM)中的程序而执行各种适当的动作和处理。处理器例如可以包括通用微处理器(例如CPU)、指令集处理器和/或相关芯片组和/或专用微处理器(例如,专用集成电路(ASIC)),等等。处理器还可以包括用于缓存用途的板载存储器。处理器可以包括用于执行根据本实施例的方法流程的不同动作的单一处理单元或者是多个处理单元。The computer-readable storage medium may also be referred to as a memory, and the executable instructions may also be referred to as a program. The processor may perform various appropriate actions and processes according to programs stored in read only memory (ROM) or loaded into random access memory (RAM). A processor may include, for example, a general-purpose microprocessor (eg, a CPU), an instruction set processor and/or a related chipset, and/or a special-purpose microprocessor (eg, an application specific integrated circuit (ASIC)), among others. The processor may also include onboard memory for caching purposes. The processor may comprise a single processing unit or multiple processing units for performing different actions of the method flow according to this embodiment.
处理器、ROM以及RAM通过总线彼此相连。处理器通过执行ROM和/或RAM中的程序来执行根据本实施例的方法流程的各种操作。需要注意,程序也可以存储在除ROM和RAM以外的一个或多个存储器中。 处理器也可以通过执行存储在一个或多个存储器中的程序来执行根据本实施例的方法流程的各种操作。The processor, ROM, and RAM are connected to each other through a bus. The processor performs various operations of the method flow according to the present embodiment by executing programs in the ROM and/or RAM. Note that programs may also be stored in one or more memories other than ROM and RAM. The processor may also perform various operations of the method flow according to the present embodiment by executing programs stored in one or more memories.
根据本实施例,应用计算机可读存储介质的装置还可以包括输入/输出(I/O)接口,输入/输出(I/O)接口也连接至总线。应用计算机可读存储介质的装置还可以包括连接至I/O接口的以下部件中的一项或多项:包括键盘、鼠标等的输入部分;包括诸如阴极射线管(CRT)、液晶显示器(LCD)等以及扬声器等的输出部分;包括硬盘等的存储部分;以及包括诸如LAN卡、调制解调器等的网络接口卡的通信部分。通信部分经由诸如因特网的网络执行通信处理。驱动器也根据需要连接至I/O接口。可拆卸介质,诸如磁盘、光盘、磁光盘、半导体存储器等等,根据需要安装在驱动器上,以便于从其上读出的计算机程序根据需要被安装入存储部分。According to the present embodiment, the apparatus to which the computer-readable storage medium is applied may further include an input/output (I/O) interface, which is also connected to the bus. The device employing the computer-readable storage medium may also include one or more of the following components connected to the I/O interface: an input portion including a keyboard, a mouse, etc.; an input portion such as a cathode ray tube (CRT), a liquid crystal display (LCD) ), etc., and an output section for speakers, etc.; a storage section including a hard disk, etc.; and a communication section including a network interface card such as a LAN card, a modem, and the like. The communication section performs communication processing via a network such as the Internet. Drives are also connected to the I/O interface as required. Removable media, such as magnetic disks, optical disks, magneto-optical disks, semiconductor memories, etc., are mounted on the drive as needed, so that the computer program read therefrom is installed into the storage section as needed.
根据本实施例的方法流程可以被实现为计算机软件程序。例如,本实施例包括一种计算机程序产品,其包括承载在计算机可读存储介质上的计算机程序,该计算机程序包含用于执行流程图所示的方法的程序代码。在这样的实施例中,该计算机程序可以通过通信部分从网络上被下载和安装,和/或从可拆卸介质被安装。在该计算机程序被处理器执行时,执行本实施例的系统中限定的上述功能。The method flow according to this embodiment can be implemented as a computer software program. For example, the present embodiment includes a computer program product comprising a computer program carried on a computer-readable storage medium, the computer program containing program code for performing the method shown in the flowchart. In such an embodiment, the computer program may be downloaded and installed from a network via the communication portion, and/or installed from a removable medium. When the computer program is executed by the processor, the above-described functions defined in the system of the present embodiment are executed.
可以理解地,计算机可读存储介质可以包括但不限于非易失性或易失性存储介质,例如随机存取存储器(RAM)、静态RAM、动态RAM、只读存储器(ROM)、可编程ROM、可擦除可编程ROM、电可擦除可编程ROM、闪存、安全数字(SD)卡等。It will be appreciated that computer readable storage media may include, but are not limited to, non-volatile or volatile storage media such as random access memory (RAM), static RAM, dynamic RAM, read only memory (ROM), programmable ROM , Erasable Programmable ROM, Electrically Erasable Programmable ROM, Flash Memory, Secure Digital (SD) Card, etc.
本实施例还提供了一种可移动平台的控制装置,可移动平台包括用于搭载负载的云台以及用于支撑云台的支撑机构。This embodiment also provides a control device for a movable platform, where the movable platform includes a pan-tilt for carrying loads and a support mechanism for supporting the pan-tilt.
控制装置包括存储器以及处理器。存储器用于存储可执行指令,处理器用于执行存储器中存储的可执行指令,以执行如下操作:获取可移动平台当前所处的运动模式,其中,可移动平台具有多个运动模式,不同运动模式下的可移动平台的控制方式不同;根据可移动平台当前所处的运动模式,确定云台进入相应的云台模式,云台模式包括用于保持负载的对地姿态稳定的增稳模式、以及用于保持负载与支撑 机构的相对姿态稳定的跟随模式。The control device includes a memory and a processor. The memory is used to store the executable instructions, and the processor is used to execute the executable instructions stored in the memory, so as to perform the following operations: obtain the current motion mode of the movable platform, wherein the movable platform has multiple motion modes, and different motion modes The control methods of the movable platforms are different; according to the current motion mode of the movable platform, it is determined that the gimbal enters the corresponding gimbal mode. Follow mode used to keep the relative attitude of the load and support mechanism stable.
可以理解地,控制装置可以位于可移动平台,也可以独立于可移动平台并与可移动平台通信连接。It can be understood that the control device may be located on the movable platform, or may be independent of the movable platform and be communicatively connected with the movable platform.
可移动平台还可以包括定位装置和检测装置,定位装置用于获取可移动平台的位置信息,检测装置用于检测可移动平台的周围障碍物信息;不同运动模式下,定位装置和/或检测装置的使用状态不同,以使得可移动平台具有不同的控制方式。The movable platform may also include a positioning device and a detection device, the positioning device is used to obtain the position information of the movable platform, and the detection device is used to detect the surrounding obstacle information of the movable platform; in different motion modes, the positioning device and/or the detection device The usage status of the mobile platform is different, so that the movable platform has different control methods.
该多个运动模式可以包括第一运动模式,当可移动平台处于第一运动模式时,定位装置的使用状态为开启,检测装置的使用状态为开启周围障碍物信息用于可移动平台在第一方向以及第二方向上视觉避障的功能。处理器还可以执行如下操作:当可移动平台的当前所处的运动模式为第一运动模式时,确定云台进入增稳模式。The plurality of motion modes may include a first motion mode. When the movable platform is in the first motion mode, the use state of the positioning device is turned on, and the use state of the detection device is to turn on the surrounding obstacle information for the movable platform in the first motion mode. Orientation and visual obstacle avoidance in the second direction. The processor may further perform the following operation: when the current motion mode of the movable platform is the first motion mode, determine that the pan/tilt head enters the stabilization mode.
该多个运动模式包括第二运动模式,当可移动平台处于第二运动模式时,定位装置的使用状态为开启,检测装置的使用状态为开启周围障碍物信息用于可移动平台在第一方向上视觉避障的功能,并关闭周围障碍物信息用于可移动平台在第二方向上视觉避障的功能。处理器还执行如下操作:当可移动平台的当前所处的运动模式为第二运动模式时,确定云台进入增稳模式。The plurality of motion modes include a second motion mode. When the movable platform is in the second motion mode, the use state of the positioning device is turned on, and the use state of the detection device is to turn on the surrounding obstacle information for the movable platform in the first party. The function of upward visual obstacle avoidance is turned off, and the surrounding obstacle information is used for the visual obstacle avoidance function of the movable platform in the second direction. The processor also performs the following operation: when the current motion mode of the movable platform is the second motion mode, it is determined that the pan-tilt head enters the stabilization mode.
该多个运动模式包括第三运动模式,当可移动平台处于第三运动模式时,定位装置的使用状态为关闭位置信息用于控制可移动平台的位置的功能,检测装置的使用状态为关闭周围障碍物信息用于可移动平台在第一方向以及第二方向上视觉避障的功能。处理器还执行如下操作:当可移动平台的当前所处的运动模式为第三运动模式时,确定云台进入跟随模式。The plurality of motion modes include a third motion mode. When the movable platform is in the third motion mode, the use state of the positioning device is to close the function of the position information for controlling the position of the movable platform, and the use state of the detection device is to close the surrounding The obstacle information is used for the visual obstacle avoidance function of the movable platform in the first direction and the second direction. The processor also performs the following operation: when the current motion mode of the movable platform is the third motion mode, it is determined that the pan-tilt head enters the follow mode.
在处理器控制云台进入跟随模式之前,处理器还可以执行如下操作:判断可移动平台处于第三运动模式的原因;当判断的结果指示可移动平台处于第三运动模式的原因是响应于用户的输入指令时,则触发确定云台进入跟随模式的步骤。Before the processor controls the pan/tilt to enter the following mode, the processor may also perform the following operations: determine the reason why the movable platform is in the third motion mode; when the result of the judgment indicates that the reason why the movable platform is in the third motion mode is in response to the user When the input command is entered, the step of determining that the gimbal enters the follow mode is triggered.
处理器还可以执行如下操作:当判断的结果指示可移动平台处于第三运动模式的原因是可移动平台由上一运动模式自动切换到第三 运动模式时,确定云台维持处于上一运动模式对应的增稳模式或跟随模式。The processor may also perform the following operations: when the result of the judgment indicates that the movable platform is in the third movement mode because the movable platform is automatically switched from the last movement mode to the third movement mode, determine that the gimbal remains in the last movement mode Corresponding stabilization mode or follow mode.
定位装置可以包括全球定位系统,检测装置可以包括视觉定位系统。The positioning means may comprise a global positioning system, and the detection means may comprise a visual positioning system.
可移动平台由上一运动模式自动切换到第三运动模式的触发条件可以包括全球定位系统以及视觉定位系统的检测信息的可靠性降低。The triggering condition for the movable platform to automatically switch from the previous motion mode to the third motion mode may include a decrease in reliability of detection information of the global positioning system and the visual positioning system.
处理器还可以执行如下操作:当全球定位系统的信号低于预设信号阈值时,确定全球定位系统的检测信息的可靠性降低。The processor may further perform the following operation: when the signal of the global positioning system is lower than a preset signal threshold, the reliability of determining the detection information of the global positioning system is reduced.
处理器还可以执行如下操作:当可移动平台周围的光照低于预设亮度阈值时,确定视觉定位系统的检测信息的可靠性降低。The processor may further perform the following operation: when the illumination around the movable platform is lower than the preset brightness threshold, the reliability of determining the detection information of the visual positioning system is reduced.
该多个运动模式包括第四运动模式,当可移动平台处于第四运动模式时,定位装置的使用状态为开启,且,检测装置的使用状态为关闭周围障碍物信息用于可移动平台在第一方向以及第二方向上视觉避障的功能。处理器还可以执行如下操作:当可移动平台的当前所处的运动模式为第四运动模式时,控制云台进入跟随模式。The plurality of motion modes include a fourth motion mode. When the movable platform is in the fourth motion mode, the use state of the positioning device is turned on, and the use state of the detection device is to turn off the surrounding obstacle information for the movable platform to operate in the fourth motion mode. The function of visual obstacle avoidance in one direction and the second direction. The processor may also perform the following operation: when the current motion mode of the movable platform is the fourth motion mode, control the pan/tilt to enter the follow mode.
第一方向可以包括竖直方向,第二方向可以包括水平方向。The first direction may include a vertical direction, and the second direction may include a horizontal direction.
处理器还可以执行如下操作:在可移动平台根据预设控制指令执行运动操作时,控制云台为增稳模式。The processor may also perform the following operation: when the movable platform performs a motion operation according to the preset control instruction, control the pan/tilt to be in a stabilization mode.
处理器还可以执行如下操作:在可移动平台根据预设控制指令执行运动操作的过程中停止触发获取可移动平台当前所处的运动模式的步骤。The processor may further perform the following operation: stop triggering the step of acquiring the current motion mode of the movable platform during the process of the movable platform performing the motion operation according to the preset control instruction.
可移动平台可以包括飞行器,预设控制指令可以包括返航指令或降落指令。The movable platform may include an aircraft, and the preset control command may include a return home command or a landing command.
处理器还可以执行如下操作:在可移动平台开机时,控制云台进入跟随模式。The processor can also perform the following operations: when the movable platform is powered on, it controls the PTZ to enter the follow mode.
处理器还可以执行如下操作:在可移动平台开机时至满足设定条件时的过程中停止触发检测可移动平台当前所处的运动模式的步骤。The processor may further perform the following operation: stop triggering the step of detecting the motion mode currently in which the movable platform is located during the period from when the movable platform is powered on to when the set condition is satisfied.
设定条件可以包括:可移动平台开机后的时长达到时长阈值;或可移动平台获取到运动模式的选择指令。The setting conditions may include: the time period after the movable platform is powered on reaches a time period threshold; or the movable platform obtains an instruction for selecting a motion mode.
当云台由跟随模式进入增稳模式时,处理器还可以执行如下操作:控制增稳模式下负载的测量对地姿态为跟随模式下负载与支撑机构的目标相对姿态角对应的目标对地姿态。When the gimbal enters the stabilization mode from the follow mode, the processor can also perform the following operations: control the measured ground attitude of the load in the stabilization mode to be the target ground attitude corresponding to the target relative attitude angle of the load and the support mechanism in the follow mode .
当云台由增稳模式进入跟随模式时,处理器还可以执行如下操作:控制跟随模式下负载与支撑机构的测量相对姿态角为增稳模式下负载的目标对地姿态对应的目标相对姿态角。When the gimbal enters the follow mode from the stabilization mode, the processor can also perform the following operations: control the measured relative attitude angle of the load and the support mechanism in the follow mode to the target relative attitude angle corresponding to the target ground attitude of the load in the stabilization mode .
云台处于跟随模式时,处理器还可以执行如下操作:确定负载与支撑机构的目标相对姿态角;获取负载与支撑机构的测量相对姿态角;根据目标相对姿态角以及测量相对姿态角控制云台,以保持负载与支撑机构的相对姿态稳定。When the gimbal is in the follow mode, the processor can also perform the following operations: determine the target relative attitude angle between the load and the support mechanism; obtain the measured relative attitude angle between the load and the support mechanism; control the gimbal according to the target relative attitude angle and the measured relative attitude angle , to keep the relative posture of the load and the support mechanism stable.
处理器还可以执行如下操作:根据目标相对姿态角以及测量相对姿态角确定负载与支撑机构间的目标相对姿态角速度;获取负载与支撑机构间的测量相对姿态角速度;根据目标相对姿态角速度以及测量相对姿态角速度确定云台的电机的控制力矩;根据控制力矩控制电机,以保持负载与支撑机构的相对姿态稳定。The processor may also perform the following operations: determine the target relative attitude angular velocity between the load and the support mechanism according to the target relative attitude angle and the measured relative attitude angle; obtain the measured relative attitude angular velocity between the load and the support mechanism; according to the target relative attitude angular velocity and the measured relative attitude angular velocity; The attitude angular velocity determines the control torque of the motor of the gimbal; the motor is controlled according to the control torque to keep the relative attitude of the load and the support mechanism stable.
处理器还可以执行如下操作:获取云台受到的外部扰动,外部扰动能够使得云台的位置和/或姿态发生变化;根据目标相对姿态角速度、测量相对姿态角速度以及外部扰动确定控制力矩。The processor may also perform the following operations: acquire external disturbances to the gimbal, which can change the position and/or attitude of the gimbal; determine the control torque according to the target relative attitude angular velocity, the measured relative attitude angular velocity, and the external disturbance.
云台处于跟随模式时,处理器还可以执行如下操作:确定负载的对地目标姿态角;获取负载的对地测量姿态角;根据对地目标姿态角以及负载的对地测量姿态角控制云台,以保持负载与支撑机构的相对姿态稳定。When the gimbal is in the following mode, the processor can also perform the following operations: determine the ground target attitude angle of the load; obtain the ground measurement attitude angle of the load; control the gimbal according to the ground target attitude angle and the load ground measurement attitude angle , to keep the relative posture of the load and the support mechanism stable.
负载的对地目标姿态角可以由支撑机构的对地测量姿态角确定。The ground target attitude angle of the load can be determined by the ground measurement attitude angle of the support mechanism.
处理器还可以执行如下操作:根据对地目标姿态角以及负载的对地测量姿态角确定负载的对地目标角速度;获取负载的对地测量角速度;根据对地目标角速度以及对地测量角速度确定云台的电机的控制力矩;根据控制力矩控制电机,以保持负载与支撑机构的相对姿态稳定。The processor may also perform the following operations: determine the ground target angular velocity of the load according to the ground target attitude angle and the ground measurement attitude angle of the load; obtain the ground measurement angular velocity of the load; determine the cloud according to the ground target angular velocity and the ground measurement angular velocity Control torque of the motor of the platform; control the motor according to the control torque to keep the relative posture of the load and the support mechanism stable.
处理器还可以执行如下操作:获取云台受到的外部扰动,外部扰动能够使得云台的位置和/或姿态发生变化;根据对地目标角速度、 对地测量角速度以及外部扰动确定控制力矩。The processor may also perform the following operations: acquire external disturbances to the gimbal, which can change the position and/or attitude of the gimbal; determine the control torque according to the target angular velocity on the ground, the measured angular velocity on the ground, and the external disturbance.
本实施例还提供了一种可移动平台,可移动平台包括用于搭载负载的云台以及用于支撑云台的支撑机构。This embodiment also provides a movable platform, and the movable platform includes a pan-tilt for carrying loads and a support mechanism for supporting the pan-tilt.
可移动平台还包括存储器以及处理器。存储器用于存储可执行指令。处理器用于执行存储器中存储的可执行指令,以执行如下操作:获取可移动平台当前所处的运动模式,其中,可移动平台具有多个运动模式,不同运动模式下的可移动平台的控制方式不同;根据可移动平台的当前所处的运动模式,确定云台进入相应的云台模式,云台模式包括用于保持负载的对地姿态稳定的增稳模式、以及用于保持负载与支撑机构的相对姿态稳定的跟随模式。The removable platform also includes memory and a processor. Memory is used to store executable instructions. The processor is configured to execute the executable instructions stored in the memory, so as to perform the following operations: obtain the current motion mode of the movable platform, wherein the movable platform has multiple motion modes, and the control modes of the movable platform under different motion modes Different; according to the current motion mode of the movable platform, it is determined that the gimbal enters the corresponding gimbal mode. The gimbal mode includes a stabilization mode for maintaining the stability of the load's attitude towards the ground, and a stabilization mode for maintaining the load and supporting mechanism. The relative attitude of the following mode is stable.
可移动平台还可以包括定位装置和检测装置,定位装置用于获取可移动平台的位置信息,检测装置用于检测可移动平台的周围障碍物信息;不同运动模式下,定位装置和/或检测装置的使用状态不同,以使得可移动平台具有不同的控制方式。The movable platform may also include a positioning device and a detection device, the positioning device is used to obtain the position information of the movable platform, and the detection device is used to detect the surrounding obstacle information of the movable platform; in different motion modes, the positioning device and/or the detection device The usage status of the mobile platform is different, so that the movable platform has different control methods.
该多个运动模式可以包括第一运动模式,当可移动平台处于第一运动模式时,定位装置的使用状态为开启,检测装置的使用状态为开启周围障碍物信息用于可移动平台在第一方向以及第二方向上视觉避障的功能。处理器还可以执行如下操作:当可移动平台的当前所处的运动模式为第一运动模式时,确定云台进入增稳模式。The plurality of motion modes may include a first motion mode. When the movable platform is in the first motion mode, the use state of the positioning device is turned on, and the use state of the detection device is to turn on the surrounding obstacle information for the movable platform in the first motion mode. Orientation and visual obstacle avoidance in the second direction. The processor may further perform the following operation: when the current motion mode of the movable platform is the first motion mode, determine that the pan/tilt head enters the stabilization mode.
该多个运动模式可以包括第二运动模式,当可移动平台处于第二运动模式时,定位装置的使用状态为开启,检测装置的使用状态为开启周围障碍物信息用于可移动平台在第一方向上视觉避障的功能,并关闭周围障碍物信息用于可移动平台在第二方向上视觉避障的功能。处理器还可以执行如下操作:当可移动平台的当前所处的运动模式为第二运动模式时,确定云台进入增稳模式。The plurality of motion modes may include a second motion mode. When the movable platform is in the second motion mode, the use state of the positioning device is turned on, and the use state of the detection device is to turn on the surrounding obstacle information for the movable platform in the first motion mode. The function of visual obstacle avoidance in the direction is turned off, and the surrounding obstacle information is used for the visual obstacle avoidance function of the movable platform in the second direction. The processor may further perform the following operation: when the current motion mode of the movable platform is the second motion mode, determine that the pan/tilt head enters the stabilization mode.
该多个运动模式可以包括第三运动模式,当可移动平台处于第三运动模式时,定位装置的使用状态为关闭位置信息用于控制可移动平台的位置的功能,检测装置的使用状态为关闭周围障碍物信息用于可移动平台在第一方向以及第二方向上视觉避障的功能。处理器还执行如下操作:当可移动平台的当前所处的运动模式为第三运动模式时, 确定云台进入跟随模式。The plurality of motion modes may include a third motion mode. When the movable platform is in the third motion mode, the use state of the positioning device is to turn off the function of the position information for controlling the position of the movable platform, and the use state of the detection device is to turn off The surrounding obstacle information is used for the visual obstacle avoidance function of the movable platform in the first direction and the second direction. The processor also performs the following operation: when the current motion mode of the movable platform is the third motion mode, it is determined that the pan-tilt head enters the follow mode.
在处理器控制云台进入跟随模式之前,处理器还可以执行如下操作:判断可移动平台处于第三运动模式的原因;当判断的结果指示可移动平台处于第三运动模式的原因是响应于用户的输入指令时,则触发确定云台进入跟随模式的步骤。Before the processor controls the pan/tilt to enter the following mode, the processor may also perform the following operations: determine the reason why the movable platform is in the third motion mode; when the result of the judgment indicates that the reason why the movable platform is in the third motion mode is in response to the user When the input command is entered, the step of determining that the gimbal enters the follow mode is triggered.
处理器还可以执行如下操作:当判断的结果指示可移动平台处于第三运动模式的原因是可移动平台由上一运动模式自动切换到第三运动模式时,确定云台维持处于上一运动模式对应的增稳模式或跟随模式。The processor may also perform the following operations: when the result of the judgment indicates that the movable platform is in the third movement mode because the movable platform is automatically switched from the last movement mode to the third movement mode, determine that the gimbal remains in the last movement mode Corresponding stabilization mode or follow mode.
定位装置可以包括全球定位系统,检测装置可以包括视觉定位系统。The positioning means may comprise a global positioning system, and the detection means may comprise a visual positioning system.
可移动平台由上一运动模式自动切换到第三运动模式的触发条件可以包括全球定位系统以及视觉定位系统的检测信息的可靠性降低。The triggering condition for the movable platform to automatically switch from the previous motion mode to the third motion mode may include a decrease in reliability of detection information of the global positioning system and the visual positioning system.
处理器还可以执行如下操作:当全球定位系统的信号低于预设信号阈值时,确定全球定位系统的检测信息的可靠性降低。The processor may further perform the following operation: when the signal of the global positioning system is lower than a preset signal threshold, the reliability of determining the detection information of the global positioning system is reduced.
处理器还可以执行如下操作:当可移动平台周围的光照低于预设亮度阈值时,确定视觉定位系统的检测信息的可靠性降低。The processor may further perform the following operation: when the illumination around the movable platform is lower than the preset brightness threshold, the reliability of determining the detection information of the visual positioning system is reduced.
该多个运动模式可以包括第四运动模式,当可移动平台处于第四运动模式时,定位装置的使用状态为开启,且,检测装置的使用状态为关闭周围障碍物信息用于可移动平台在第一方向以及第二方向上视觉避障的功能。处理器还可以执行如下操作:当可移动平台的当前所处的运动模式为第四运动模式时,确定云台进入跟随模式。The plurality of motion modes may include a fourth motion mode. When the movable platform is in the fourth motion mode, the use state of the positioning device is turned on, and the use state of the detection device is to turn off the surrounding obstacle information for the movable platform to operate in the fourth motion mode. The function of visual obstacle avoidance in the first direction and the second direction. The processor may also perform the following operation: when the current motion mode of the movable platform is the fourth motion mode, it is determined that the pan-tilt head enters the follow mode.
第一方向可以包括竖直方向,第二方向可以包括水平方向。The first direction may include a vertical direction, and the second direction may include a horizontal direction.
处理器还可以执行如下操作:在可移动平台根据预设控制指令执行运动操作时,控制云台为增稳模式。The processor may also perform the following operation: when the movable platform performs a motion operation according to the preset control instruction, control the pan/tilt to be in a stabilization mode.
处理器还可以执行如下操作:在可移动平台根据预设控制指令执行运动操作的过程中停止触发检测可移动平台当前所处的运动模式的步骤。The processor may further perform the following operation: stop the step of triggering and detecting the motion mode that the movable platform is currently in during the process that the movable platform performs the motion operation according to the preset control instruction.
可移动平台可以包括飞行器,预设控制指令可以包括返航指令或 降落指令。The movable platform may include an aircraft, and the preset control command may include a return home command or a landing command.
处理器还可以执行如下操作:在可移动平台开机时,控制云台进入跟随模式。The processor can also perform the following operations: when the movable platform is powered on, it controls the PTZ to enter the follow mode.
处理器还可以执行如下操作:在可移动平台开机时至满足设定条件时的过程中停止触发检测可移动平台当前所处的运动模式的步骤。The processor may further perform the following operation: stop triggering the step of detecting the motion mode currently in which the movable platform is located during the period from when the movable platform is powered on to when the set condition is satisfied.
设定条件可以包括:可移动平台开机后的时长达到时长阈值,或,可移动平台获取到运动模式的选择指令。The setting conditions may include: the time period after the movable platform is powered on reaches a time period threshold, or the movable platform obtains a motion mode selection instruction.
当云台由跟随模式进入增稳模式时,处理器还可以执行如下操作:控制增稳模式下负载的测量对地姿态为跟随模式下负载与支撑机构的目标相对姿态角对应的目标对地姿态。When the gimbal enters the stabilization mode from the follow mode, the processor can also perform the following operations: control the measured ground attitude of the load in the stabilization mode to be the target ground attitude corresponding to the target relative attitude angle of the load and the support mechanism in the follow mode .
当云台由增稳模式进入跟随模式时,处理器还可以执行如下操作:控制跟随模式下负载与支撑机构的测量相对姿态角为增稳模式下负载的目标对地姿态对应的目标相对姿态角。When the gimbal enters the follow mode from the stabilization mode, the processor can also perform the following operations: control the measured relative attitude angle of the load and the support mechanism in the follow mode to the target relative attitude angle corresponding to the target ground attitude of the load in the stabilization mode .
云台处于跟随模式时,处理器还可以执行如下操作:确定负载与支撑机构的目标相对姿态角;获取负载与支撑机构的测量相对姿态角;根据目标相对姿态角以及测量相对姿态角控制云台,以保持负载与支撑机构的相对姿态稳定。When the gimbal is in the follow mode, the processor can also perform the following operations: determine the target relative attitude angle between the load and the support mechanism; obtain the measured relative attitude angle between the load and the support mechanism; control the gimbal according to the target relative attitude angle and the measured relative attitude angle , to keep the relative posture of the load and the support mechanism stable.
处理器还可以执行如下操作:根据目标相对姿态角以及测量相对姿态角确定负载与支撑机构间的目标相对姿态角速度;获取负载与支撑机构间的测量相对姿态角速度;根据目标相对姿态角速度以及测量相对姿态角速度确定云台的电机的控制力矩;根据控制力矩控制电机,以保持负载与支撑机构的相对姿态稳定。The processor may also perform the following operations: determine the target relative attitude angular velocity between the load and the support mechanism according to the target relative attitude angle and the measured relative attitude angle; obtain the measured relative attitude angular velocity between the load and the support mechanism; according to the target relative attitude angular velocity and the measured relative attitude angular velocity; The attitude angular velocity determines the control torque of the motor of the gimbal; the motor is controlled according to the control torque to keep the relative attitude of the load and the support mechanism stable.
处理器还可以执行如下操作:获取云台受到的外部扰动,外部扰动能够使得云台的位置和/或姿态发生变化;根据目标相对姿态角速度、测量相对姿态角速度以及外部扰动确定控制力矩。The processor may also perform the following operations: acquire external disturbances to the gimbal, which can change the position and/or attitude of the gimbal; determine the control torque according to the target relative attitude angular velocity, the measured relative attitude angular velocity, and the external disturbance.
云台处于跟随模式时,处理器还可以执行如下操作:确定负载的对地目标姿态角;获取负载的对地测量姿态角;根据对地目标姿态角以及负载的对地测量姿态角控制云台,以保持负载与支撑机构的相对姿态稳定。When the gimbal is in the following mode, the processor can also perform the following operations: determine the ground target attitude angle of the load; obtain the ground measurement attitude angle of the load; control the gimbal according to the ground target attitude angle and the load ground measurement attitude angle , to keep the relative posture of the load and the support mechanism stable.
负载的对地目标姿态角可以由支撑机构的对地测量姿态角确定。The ground target attitude angle of the load can be determined by the ground measurement attitude angle of the support mechanism.
处理器还可以执行如下操作:根据对地目标姿态角以及负载的对地测量姿态角确定负载的对地目标角速度;获取负载的对地测量角速度;根据对地目标角速度以及对地测量角速度确定云台的电机的控制力矩;根据控制力矩控制电机,以保持负载与支撑机构的相对姿态稳定。The processor may also perform the following operations: determine the ground target angular velocity of the load according to the ground target attitude angle and the ground measurement attitude angle of the load; obtain the ground measurement angular velocity of the load; determine the cloud according to the ground target angular velocity and the ground measurement angular velocity Control torque of the motor of the platform; control the motor according to the control torque to keep the relative posture of the load and the support mechanism stable.
处理器还可以执行如下操作:获取云台受到的外部扰动,外部扰动能够使得云台的位置和/或姿态发生变化;根据对地目标角速度、对地测量角速度以及外部扰动确定控制力矩。The processor may also perform the following operations: acquire external disturbances to the gimbal, which can change the position and/or attitude of the gimbal; determine the control torque according to the target angular velocity on the ground, the measured angular velocity on the ground, and the external disturbance.
本实施例还提供了一种可移动平台组件,可移动平台组件包括可移动平台以及遥控终端。可移动平台为上述任一可移动平台,遥控终端与可移动平台通信连接,用于控制可移动平台,其中,可移动平台的运动模式能够通过遥控终端进行切换。其中,遥控终端可以包括可移动平台的遥控器或智能终端,例如,手机、平板、电脑、智能手环、VR眼镜、手柄等,可通过物理部件(如按键或摇杆)或虚拟按键切换可移动平台的运动模式。This embodiment also provides a movable platform assembly, and the movable platform assembly includes a movable platform and a remote control terminal. The movable platform is any of the above-mentioned movable platforms, and the remote control terminal is communicatively connected to the movable platform for controlling the movable platform, wherein the movement mode of the movable platform can be switched through the remote control terminal. The remote control terminal may include a remote control or smart terminal of a mobile platform, such as a mobile phone, tablet, computer, smart bracelet, VR glasses, handle, etc., which can be switched by physical components (such as buttons or joysticks) or virtual buttons. Movement mode of the mobile platform.
其中,在可移动平台为无人机时,上述说明的P、S、M、A挡可通过用户手动操作遥控终端进行切换,A挡还可以是可移动平台自动进入。Wherein, when the movable platform is an unmanned aerial vehicle, the P, S, M, and A gears described above can be switched by the user manually operating the remote control terminal, and the A gear can also be automatically entered by the movable platform.
对于本申请的实施例,还需要说明的是,在不冲突的情况下,本申请的实施例及实施例中的特征可以相互组合以得到新的实施例。For the embodiments of the present application, it should also be noted that, in the case of no conflict, the embodiments of the present application and the features in the embodiments may be combined with each other to obtain new embodiments.
以上仅为本申请的优选实施例而已,并不用于限制本申请,对于本领域的技术人员来说,本申请可以有各种更改和变化。凡在本申请的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本申请的保护范围之内。The above are only preferred embodiments of the present application, and are not intended to limit the present application. For those skilled in the art, the present application may have various modifications and changes. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of this application shall be included within the protection scope of this application.

Claims (86)

  1. 一种可移动平台的控制方法,其特征在于,所述控制方法包括:A control method for a movable platform, characterized in that the control method comprises:
    获取所述可移动平台当前所处的运动模式,其中,所述可移动平台具有多个运动模式,不同运动模式下的所述可移动平台的控制方式不同,且所述可移动平台包括用于搭载负载的云台以及用于支撑所述云台的支撑机构;Acquire the motion mode that the movable platform is currently in, wherein the movable platform has multiple motion modes, the control modes of the movable platform in different motion modes are different, and the movable platform includes a a load-carrying pan/tilt and a support mechanism for supporting the pan/tilt;
    根据所述可移动平台的当前所处的所述运动模式,确定所述云台进入相应的云台模式,所述云台模式包括用于保持所述负载的对地姿态稳定的增稳模式、以及用于保持所述负载与所述支撑机构的相对姿态稳定的跟随模式。According to the motion mode that the movable platform is currently in, it is determined that the gimbal enters a corresponding gimbal mode, and the gimbal mode includes a stabilization mode for maintaining a stable attitude of the load to the ground, and a following mode for keeping the relative posture of the load and the support mechanism stable.
  2. 根据权利要求1所述的控制方法,其特征在于,所述可移动平台还包括定位装置和检测装置,所述定位装置用于获取所述可移动平台的位置信息,所述检测装置用于检测所述可移动平台的周围障碍物信息;The control method according to claim 1, wherein the movable platform further comprises a positioning device and a detection device, the positioning device is used to obtain the position information of the movable platform, and the detection device is used to detect surrounding obstacle information of the movable platform;
    不同运动模式下,所述定位装置和/或所述检测装置的使用状态不同,以使得所述可移动平台具有不同的控制方式。In different motion modes, the positioning device and/or the detection device has different usage states, so that the movable platform has different control modes.
  3. 根据权利要求2所述的控制方法,其特征在于,所述多个运动模式包括第一运动模式,当所述可移动平台处于所述第一运动模式时,所述定位装置的使用状态为开启,所述检测装置的使用状态为开启所述周围障碍物信息用于所述可移动平台在第一方向以及第二方向上视觉避障的功能;The control method according to claim 2, wherein the plurality of motion modes include a first motion mode, and when the movable platform is in the first motion mode, the use state of the positioning device is ON , the use state of the detection device is to enable the function of the surrounding obstacle information for the movable platform to visually avoid obstacles in the first direction and the second direction;
    所述根据所述可移动平台的当前所处的所述运动模式,确定所述云台进入相应的云台模式,包括:The determining that the PTZ enters a corresponding PTZ mode according to the current motion mode of the movable platform includes:
    当所述可移动平台的当前所处的所述运动模式为所述第一运动模式时,确定所述云台进入所述增稳模式。When the current motion mode of the movable platform is the first motion mode, it is determined that the pan/tilt head enters the stabilization mode.
  4. 根据权利要求2所述的控制方法,其特征在于,所述多个运动模式包括第二运动模式,当所述可移动平台处于所述第二运动模式时,所述定位装置的使用状态为开启,所述检测装置的使用状态为开启所述周围障碍物信息用于所述可移动平台在第一方向上视觉避障的功能,并关闭所述周围障碍物信息用于所述可移动平台在第二方向上视觉避障的功能;The control method according to claim 2, wherein the plurality of motion modes include a second motion mode, and when the movable platform is in the second motion mode, the use state of the positioning device is ON , the use state of the detection device is to enable the function of the surrounding obstacle information for the movable platform to visually avoid obstacles in the first direction, and to turn off the surrounding obstacle information for the movable platform in the first direction. The function of visual obstacle avoidance in the second direction;
    所述根据所述可移动平台的当前所处的所述运动模式,确定所述云台进入相应的云台模式,包括:The determining that the PTZ enters a corresponding PTZ mode according to the current motion mode of the movable platform includes:
    当所述可移动平台的当前所处的所述运动模式为所述第二运动模式时,确定所述云台进入所述增稳模式。When the current motion mode of the movable platform is the second motion mode, it is determined that the gimbal enters the stabilization mode.
  5. 根据权利要求2所述的控制方法,其特征在于,所述多个运动模式包括第三运动模式,当所述可移动平台处于所述第三运动模式时,所述定位装置的使用状态为关闭所述位置信息用于控制所述可移动平台的位置的功能,所述检测装置的使用状态为关闭所述周围障碍物信息用于所述可移动平台在第一方向以及第二方向上视觉避障的功能;The control method according to claim 2, wherein the plurality of motion modes include a third motion mode, and when the movable platform is in the third motion mode, the use state of the positioning device is OFF The position information is used to control the function of the position of the movable platform, and the use state of the detection device is to turn off the surrounding obstacle information for the movable platform to visually avoid in the first direction and the second direction. impaired function;
    所述根据所述可移动平台的当前所处的所述运动模式,确定所述云台进入相应的云台模式,包括:The determining that the PTZ enters a corresponding PTZ mode according to the current motion mode of the movable platform includes:
    当所述可移动平台的当前所处的所述运动模式为所述第三运动模式时,确定所述云台进入所述跟随模式。When the current motion mode of the movable platform is the third motion mode, it is determined that the pan/tilt head enters the following mode.
  6. 根据权利要求5所述的控制方法,其特征在于,在控制所述云台进入所述跟随模式之前,还包括:The control method according to claim 5, wherein before controlling the PTZ to enter the following mode, it further comprises:
    判断所述可移动平台处于所述第三运动模式的原因;determining the reason why the movable platform is in the third motion mode;
    当所述判断的结果指示所述可移动平台处于所述第三运动模式的原因是响应于用户的输入指令时,则触发所述确定所述云台进入所述跟随模式的步骤。When the result of the judgment indicates that the reason why the movable platform is in the third motion mode is in response to the user's input instruction, the step of determining that the pan/tilt head enters the following mode is triggered.
  7. 根据权利要求6所述的控制方法,其特征在于,还包括:The control method according to claim 6, further comprising:
    当所述判断的结果指示所述可移动平台处于所述第三运动模式的原因是所述可移动平台由上一运动模式自动切换到所述第三运动模式时,确定所述云台维持处于所述上一运动模式对应的云台模式。When the result of the judgment indicates that the movable platform is in the third motion mode because the movable platform is automatically switched from the previous motion mode to the third motion mode, it is determined that the gimbal remains in the third motion mode The PTZ mode corresponding to the last motion mode.
  8. 根据权利要求7所述的控制方法,其特征在于,所述定位装置包括全球定位系统,所述检测装置包括视觉定位系统。The control method according to claim 7, wherein the positioning device includes a global positioning system, and the detection device includes a visual positioning system.
  9. 根据权利要求8所述的控制方法,其特征在于,所述可移动平台由上一运动模式自动切换到所述第三运动模式的触发条件包括所述全球定位系统以及所述视觉定位系统的检测信息的可靠性降低。The control method according to claim 8, wherein the triggering condition for the movable platform to automatically switch from the previous motion mode to the third motion mode includes detection by the global positioning system and the visual positioning system The reliability of the information is reduced.
  10. 根据权利要求9所述的控制方法,其特征在于,还包括:The control method according to claim 9, further comprising:
    当所述全球定位系统的信号低于预设信号阈值时,确定所述全球定位系统的检测信息的可靠性降低。When the signal of the global positioning system is lower than a preset signal threshold, it is determined that the reliability of the detection information of the global positioning system is reduced.
  11. 根据权利要求9所述的控制方法,其特征在于,还包括:The control method according to claim 9, further comprising:
    当所述可移动平台周围的光照低于预设亮度阈值时,确定所述视觉定位系统的检测信息的可靠性降低。When the illumination around the movable platform is lower than a preset brightness threshold, the reliability of determining the detection information of the visual positioning system is reduced.
  12. 根据权利要求2所述的控制方法,其特征在于,所述多个运动模式包括第四运动模式,当所述可移动平台处于所述第四运动模式时,所述定位装置的使用状态为开启,且,所述检测装置的使用状态为关闭所述周围障碍物信息用于所述可移动平台在第一方向以及第二方向上视觉避障的功能;The control method according to claim 2, wherein the plurality of motion modes include a fourth motion mode, and when the movable platform is in the fourth motion mode, the use state of the positioning device is ON , and the use state of the detection device is to disable the function of the surrounding obstacle information for the movable platform to visually avoid obstacles in the first direction and the second direction;
    所述根据所述可移动平台的当前所处的所述运动模式,确定所述云台进入相应的云台模式,包括:The determining that the PTZ enters a corresponding PTZ mode according to the current motion mode of the movable platform includes:
    当所述可移动平台的当前所处的所述运动模式为所述第四运动模式时,控制所述云台进入所述跟随模式。When the current motion mode of the movable platform is the fourth motion mode, the pan/tilt head is controlled to enter the following mode.
  13. 根据权利要求3至12中任一项所述的控制方法,其特征在 于,所述第一方向包括所述可移动平台的竖直方向,所述第二方向包括所述可移动平台的水平方向。The control method according to any one of claims 3 to 12, wherein the first direction includes a vertical direction of the movable platform, and the second direction includes a horizontal direction of the movable platform .
  14. 根据权利要求1所述的控制方法,其特征在于,还包括:The control method according to claim 1, further comprising:
    在所述可移动平台根据预设控制指令执行运动操作时,控制所述云台为所述增稳模式。When the movable platform performs a motion operation according to a preset control instruction, the gimbal is controlled to be in the stabilization mode.
  15. 根据权利要求14所述的控制方法,其特征在于,在所述可移动平台根据预设控制指令执行运动操作的过程中停止触发所述检测所述可移动平台当前所处的运动模式的步骤。The control method according to claim 14, characterized in that the step of triggering the step of detecting the motion mode that the movable platform is currently in is stopped during the process that the movable platform performs a motion operation according to a preset control instruction.
  16. 根据权利要求14或15所述的控制方法,其特征在于,所述可移动平台包括飞行器,所述预设控制指令包括返航指令或降落指令。The control method according to claim 14 or 15, wherein the movable platform includes an aircraft, and the preset control instruction includes a return home instruction or a landing instruction.
  17. 根据权利要求1所述的控制方法,其特征在于,还包括:The control method according to claim 1, further comprising:
    在所述可移动平台开机时,控制所述云台进入所述跟随模式。When the movable platform is powered on, the gimbal is controlled to enter the following mode.
  18. 根据权利要求17所述的控制方法,其特征在于,在所述可移动平台开机时至满足设定条件时的过程中停止触发所述获取所述可移动平台当前所处的运动模式的步骤。The control method according to claim 17, wherein the step of acquiring the current motion mode of the movable platform is stopped during the process from when the movable platform is powered on to when a set condition is satisfied.
  19. 根据权利要求18所述的控制方法,其特征在于,所述设定条件包括:The control method according to claim 18, wherein the setting conditions include:
    所述可移动平台开机后的时长达到时长阈值;或The duration of time after the movable platform is powered on reaches the duration threshold; or
    所述可移动平台获取到所述运动模式的选择指令。The movable platform obtains the selection instruction of the motion mode.
  20. 根据权利要求1所述的控制方法,其特征在于,当所述云台由所述跟随模式进入所述增稳模式时,还包括:The control method according to claim 1, wherein when the gimbal enters the stabilization mode from the follow mode, further comprising:
    控制所述增稳模式下所述负载的测量对地姿态为所述跟随模式 下所述负载与所述支撑机构的目标相对姿态角对应的目标对地姿态。The measured ground attitude of the load in the stabilization mode is controlled to be the target ground attitude corresponding to the target relative attitude angle of the load and the support mechanism in the following mode.
  21. 根据权利要求1所述的控制方法,其特征在于,当所述云台由所述增稳模式进入所述跟随模式时,还包括:The control method according to claim 1, wherein when the gimbal enters the following mode from the stabilization mode, further comprising:
    控制所述跟随模式下所述负载与所述支撑机构的测量相对姿态角为所述增稳模式下所述负载的目标对地姿态对应的目标相对姿态角。The measured relative attitude angle of the load and the support mechanism in the following mode is controlled to be the target relative attitude angle corresponding to the target ground attitude of the load in the stabilization mode.
  22. 根据权利要求1所述的控制方法,其特征在于,所述云台处于所述跟随模式时,还包括:The control method according to claim 1, wherein when the pan/tilt head is in the following mode, further comprising:
    确定所述负载与所述支撑机构的目标相对姿态角;determining the target relative attitude angle of the load and the support mechanism;
    获取所述负载与所述支撑机构的测量相对姿态角;obtaining the measured relative attitude angle of the load and the support mechanism;
    根据所述目标相对姿态角以及所述测量相对姿态角控制所述云台,以保持所述负载与所述支撑机构的相对姿态稳定。The gimbal is controlled according to the target relative attitude angle and the measured relative attitude angle, so as to keep the relative attitude of the load and the support mechanism stable.
  23. 根据权利要求22所述的控制方法,其特征在于,所述根据所述目标相对姿态角以及所述测量相对姿态角控制所述云台,以保持所述负载与所述支撑机构的相对姿态稳定,包括:The control method according to claim 22, wherein the gimbal is controlled according to the target relative attitude angle and the measured relative attitude angle, so as to keep the relative attitude of the load and the support mechanism stable ,include:
    根据所述目标相对姿态角以及所述测量相对姿态角确定所述负载与所述支撑机构间的目标相对姿态角速度;Determine the target relative attitude angular velocity between the load and the support mechanism according to the target relative attitude angle and the measured relative attitude angle;
    获取所述负载与所述支撑机构间的测量相对姿态角速度;obtaining the measured relative attitude angular velocity between the load and the support mechanism;
    根据所述目标相对姿态角速度以及所述测量相对姿态角速度确定所述云台的电机的控制力矩;Determine the control torque of the motor of the gimbal according to the target relative attitude angular velocity and the measured relative attitude angular velocity;
    根据所述控制力矩控制所述电机,以保持所述负载与所述支撑机构的相对姿态稳定。The motor is controlled according to the control torque to keep the relative posture of the load and the support mechanism stable.
  24. 根据权利要求23所述的控制方法,其特征在于,所述根据所述目标相对姿态角速度以及所述测量相对姿态角速度确定所述云台的电机的控制力矩,包括:The control method according to claim 23, wherein the determining the control torque of the motor of the gimbal according to the target relative attitude angular velocity and the measured relative attitude angular velocity comprises:
    获取所述云台受到的外部扰动,所述外部扰动能够使得所述云台 的位置和/或姿态发生变化;Acquire the external disturbance that the PTZ is subjected to, and the external disturbance can make the position and/or attitude of the PTZ change;
    根据所述目标相对姿态角速度、所述测量相对姿态角速度以及所述外部扰动确定所述控制力矩。The control torque is determined according to the target relative attitude angular velocity, the measured relative attitude angular velocity, and the external disturbance.
  25. 根据权利要求1所述的控制方法,其特征在于,所述云台处于所述跟随模式时,还包括:The control method according to claim 1, wherein when the pan/tilt head is in the following mode, further comprising:
    确定所述负载的对地目标姿态角;determining the ground target attitude angle of the payload;
    获取所述负载的对地测量姿态角;obtaining the ground measurement attitude angle of the load;
    根据所述对地目标姿态角以及所述负载的对地测量姿态角控制所述云台,以保持所述负载与所述支撑机构的相对姿态稳定。The gimbal is controlled according to the ground target attitude angle and the ground measurement attitude angle of the load, so as to keep the relative attitude of the load and the support mechanism stable.
  26. 根据权利要求25所述的控制方法,其特征在于,The control method according to claim 25, wherein,
    所述负载的对地目标姿态角由所述支撑机构的对地测量姿态角确定。The ground target attitude angle of the load is determined by the ground measurement attitude angle of the support mechanism.
  27. 根据权利要求25所述的控制方法,其特征在于,所述根据所述对地目标姿态角以及所述负载的对地测量姿态角控制所述云台,以保持所述负载与所述支撑机构的相对姿态稳定,包括:The control method according to claim 25, wherein the gimbal is controlled according to the ground target attitude angle and the ground measurement attitude angle of the load, so as to maintain the load and the support mechanism Relative attitude stability of , including:
    根据所述对地目标姿态角以及所述负载的对地测量姿态角确定所述负载的对地目标角速度;Determine the ground target angular velocity of the load according to the ground target attitude angle and the ground measurement attitude angle of the load;
    获取所述负载的对地测量角速度;obtaining the ground-measured angular velocity of the load;
    根据所述对地目标角速度以及所述对地测量角速度确定所述云台的电机的控制力矩;Determine the control torque of the motor of the gimbal according to the ground target angular velocity and the ground measurement angular velocity;
    根据所述控制力矩控制所述电机,以保持所述负载与所述支撑机构的相对姿态稳定。The motor is controlled according to the control torque to keep the relative posture of the load and the support mechanism stable.
  28. 根据权利要求27所述的控制方法,其特征在于,所述根据所述对地目标角速度以及所述对地测量角速度确定所述云台的电机的控制力矩,包括:The control method according to claim 27, wherein the determining the control torque of the motor of the gimbal according to the target angular velocity on the ground and the measured angular velocity on the ground comprises:
    获取所述云台受到的外部扰动,所述外部扰动能够使得所述云台 的位置和/或姿态发生变化;Acquire the external disturbance that the PTZ is subjected to, and the external disturbance can make the position and/or attitude of the PTZ change;
    根据所述对地目标角速度、所述对地测量角速度以及所述外部扰动确定所述控制力矩。The control torque is determined according to the target angular velocity over the ground, the measured angular velocity over the ground, and the external disturbance.
  29. 一种计算机可读存储介质,其特征在于,其存储有可执行指令,所述可执行指令在由一个或多个处理器执行时,可以使所述一个或多个处理器执行如权利要求1至28中任一项权利要求所述的控制方法。A computer-readable storage medium, characterized in that it stores executable instructions, and when executed by one or more processors, the executable instructions can cause the one or more processors to execute as claimed in claim 1 The control method of any one of claims 28 to 28.
  30. 一种可移动平台的控制装置,其特征在于,所述控制装置包括:A control device for a movable platform, characterized in that the control device comprises:
    存储器,用于存储可执行指令;memory for storing executable instructions;
    处理器,用于执行所述存储器中存储的所述可执行指令,以执行如下操作:A processor for executing the executable instructions stored in the memory to perform the following operations:
    获取所述可移动平台当前所处的运动模式,其中,所述可移动平台具有多个运动模式,不同运动模式下的所述可移动平台的控制方式不同,所述可移动平台包括用于搭载负载的云台以及用于支撑所述云台的支撑机构;Acquire the motion mode that the movable platform is currently in, wherein the movable platform has multiple motion modes, and the control modes of the movable platform under different motion modes are different. a loaded head and a support mechanism for supporting the head;
    根据所述可移动平台当前所处的所述运动模式,确定所述云台进入相应的云台模式,所述云台模式包括用于保持所述负载的对地姿态稳定的增稳模式、以及用于保持所述负载与所述支撑机构的相对姿态稳定的跟随模式。According to the motion mode in which the movable platform is currently located, it is determined that the gimbal enters a corresponding gimbal mode, where the gimbal mode includes a stabilization mode for maintaining a stable attitude of the payload towards the ground, and A follow mode for keeping the relative posture of the load and the support mechanism stable.
  31. 根据权利要求30所述的控制装置,其特征在于,所述可移动平台还包括定位装置和检测装置,所述定位装置用于获取所述可移动平台的位置信息,所述检测装置用于检测所述可移动平台的周围障碍物信息;The control device according to claim 30, wherein the movable platform further comprises a positioning device and a detection device, the positioning device is used to obtain the position information of the movable platform, and the detection device is used to detect surrounding obstacle information of the movable platform;
    不同运动模式下,所述定位装置和/或所述检测装置的使用状态不同,以使得所述可移动平台具有不同的控制方式。In different motion modes, the positioning device and/or the detection device has different usage states, so that the movable platform has different control modes.
  32. 根据权利要求31所述的控制装置,其特征在于,所述多个运动模式包括第一运动模式,当所述可移动平台处于所述第一运动模式时,所述定位装置的使用状态为开启,所述检测装置的使用状态为开启所述周围障碍物信息用于所述可移动平台在第一方向以及第二方向上视觉避障的功能;The control device according to claim 31, wherein the plurality of motion modes include a first motion mode, and when the movable platform is in the first motion mode, the use state of the positioning device is ON , the use state of the detection device is to enable the function of the surrounding obstacle information for the movable platform to visually avoid obstacles in the first direction and the second direction;
    所述处理器还执行如下操作:The processor also performs the following operations:
    当所述可移动平台的当前所处的所述运动模式为所述第一运动模式时,确定所述云台进入所述增稳模式。When the current motion mode of the movable platform is the first motion mode, it is determined that the pan/tilt head enters the stabilization mode.
  33. 根据权利要求31所述的控制装置,其特征在于,所述多个运动模式包括第二运动模式,当所述可移动平台处于所述第二运动模式时,所述定位装置的使用状态为开启,所述检测装置的使用状态为开启所述周围障碍物信息用于所述可移动平台在第一方向上视觉避障的功能,并关闭所述周围障碍物信息用于所述可移动平台在第二方向上视觉避障的功能;The control device according to claim 31, wherein the plurality of motion modes include a second motion mode, and when the movable platform is in the second motion mode, the use state of the positioning device is ON , the use state of the detection device is to enable the function of the surrounding obstacle information for the movable platform to visually avoid obstacles in the first direction, and to turn off the surrounding obstacle information for the movable platform in the first direction. The function of visual obstacle avoidance in the second direction;
    所述处理器还执行如下操作:The processor also performs the following operations:
    当所述可移动平台的当前所处的所述运动模式为所述第二运动模式时,确定所述云台进入所述增稳模式。When the current motion mode of the movable platform is the second motion mode, it is determined that the gimbal enters the stabilization mode.
  34. 根据权利要求31所述的控制装置,其特征在于,所述多个运动模式包括第三运动模式,当所述可移动平台处于所述第三运动模式时,所述定位装置的使用状态为关闭所述位置信息用于控制所述可移动平台的位置的功能,所述检测装置的使用状态为关闭所述周围障碍物信息用于所述可移动平台在第一方向以及第二方向上视觉避障的功能;The control device according to claim 31, wherein the plurality of motion modes include a third motion mode, and when the movable platform is in the third motion mode, the use state of the positioning device is OFF The position information is used to control the function of the position of the movable platform, and the use state of the detection device is to turn off the surrounding obstacle information for the movable platform to visually avoid in the first direction and the second direction. impaired function;
    所述处理器还执行如下操作:The processor also performs the following operations:
    当所述可移动平台的当前所处的所述运动模式为所述第三运动模式时,确定所述云台进入所述跟随模式。When the current motion mode of the movable platform is the third motion mode, it is determined that the pan/tilt head enters the following mode.
  35. 根据权利要求34所述的控制装置,其特征在于,在所述处 理器控制所述云台进入所述跟随模式之前,所述处理器还执行如下操作:The control device according to claim 34, wherein before the processor controls the PTZ to enter the following mode, the processor also performs the following operations:
    判断所述可移动平台处于所述第三运动模式的原因;determining the reason why the movable platform is in the third motion mode;
    当所述判断的结果指示所述可移动平台处于所述第三运动模式的原因是响应于用户的输入指令时,则触发所述确定所述云台进入所述跟随模式的步骤。When the result of the judgment indicates that the reason why the movable platform is in the third motion mode is in response to the user's input instruction, the step of determining that the pan/tilt head enters the following mode is triggered.
  36. 根据权利要求35所述的控制装置,其特征在于,所述处理器还执行如下操作:The control device according to claim 35, wherein the processor further performs the following operations:
    当所述判断的结果指示所述可移动平台处于所述第三运动模式的原因是所述可移动平台由上一运动模式自动切换到所述第三运动模式时,确定所述云台维持处于所述上一运动模式对应的云台模式。When the result of the judgment indicates that the movable platform is in the third motion mode because the movable platform is automatically switched from the previous motion mode to the third motion mode, it is determined that the gimbal remains in the third motion mode The PTZ mode corresponding to the last motion mode.
  37. 根据权利要求36所述的控制装置,其特征在于,所述定位装置包括全球定位系统,所述检测装置包括视觉定位系统。The control device according to claim 36, wherein the positioning device includes a global positioning system, and the detection device includes a visual positioning system.
  38. 根据权利要求37所述的控制装置,其特征在于,所述可移动平台由上一运动模式自动切换到所述第三运动模式的触发条件包括所述全球定位系统以及所述视觉定位系统的检测信息的可靠性降低。The control device according to claim 37, wherein the triggering condition for the movable platform to automatically switch from the previous motion mode to the third motion mode includes detection of the global positioning system and the visual positioning system The reliability of the information is reduced.
  39. 根据权利要求38所述的控制装置,其特征在于,所述处理器还执行如下操作:The control device according to claim 38, wherein the processor further performs the following operations:
    当所述全球定位系统的信号低于预设信号阈值时,确定所述全球定位系统的检测信息的可靠性降低。When the signal of the global positioning system is lower than a preset signal threshold, it is determined that the reliability of the detection information of the global positioning system is reduced.
  40. 根据权利要求38所述的控制装置,其特征在于,所述处理器还执行如下操作:The control device according to claim 38, wherein the processor further performs the following operations:
    当所述可移动平台周围的光照低于预设亮度阈值时,确定所述视觉定位系统的检测信息的可靠性降低。When the illumination around the movable platform is lower than a preset brightness threshold, the reliability of determining the detection information of the visual positioning system is reduced.
  41. 根据权利要求31所述的控制装置,其特征在于,所述多个运动模式包括第四运动模式,当所述可移动平台处于所述第四运动模式时,所述定位装置的使用状态为开启,且,所述检测装置的使用状态为关闭所述周围障碍物信息用于所述可移动平台在第一方向以及第二方向上视觉避障的功能;The control device according to claim 31, wherein the plurality of motion modes include a fourth motion mode, and when the movable platform is in the fourth motion mode, the use state of the positioning device is ON , and the use state of the detection device is to disable the function of the surrounding obstacle information for the movable platform to visually avoid obstacles in the first direction and the second direction;
    所述处理器还执行如下操作:The processor also performs the following operations:
    当所述可移动平台的当前所处的所述运动模式为所述第四运动模式时,控制所述云台进入所述跟随模式。When the current motion mode of the movable platform is the fourth motion mode, the pan/tilt head is controlled to enter the following mode.
  42. 根据权利要求32至41中任一项所述的控制装置,其特征在于,所述第一方向包括所述可移动平台的竖直方向,所述第二方向包括所述可移动平台的水平方向。The control device according to any one of claims 32 to 41, wherein the first direction includes a vertical direction of the movable platform, and the second direction includes a horizontal direction of the movable platform .
  43. 根据权利要求30所述的控制装置,其特征在于,所述处理器还执行如下操作:The control device according to claim 30, wherein the processor further performs the following operations:
    在所述可移动平台根据预设控制指令执行运动操作时,控制所述云台为所述增稳模式。When the movable platform performs a motion operation according to a preset control instruction, the gimbal is controlled to be in the stabilization mode.
  44. 根据权利要求43所述的控制装置,其特征在于,所述处理器还执行如下操作:The control device according to claim 43, wherein the processor further performs the following operations:
    在所述可移动平台根据预设控制指令执行运动操作的过程中停止触发所述获取所述可移动平台当前所处的运动模式的步骤。Stop triggering the step of acquiring the motion mode that the movable platform is currently in during the process that the movable platform performs the motion operation according to the preset control instruction.
  45. 根据权利要求43或44所述的控制装置,其特征在于,所述可移动平台包括飞行器,所述预设控制指令包括返航指令或降落指令。The control device according to claim 43 or 44, wherein the movable platform comprises an aircraft, and the preset control command comprises a return-home command or a landing command.
  46. 根据权利要求30所述的控制装置,其特征在于,所述处理器还执行如下操作:The control device according to claim 30, wherein the processor further performs the following operations:
    在所述可移动平台开机时,控制所述云台进入所述跟随模式。When the movable platform is powered on, the gimbal is controlled to enter the following mode.
  47. 根据权利要求46所述的控制装置,其特征在于,所述处理器还执行如下操作:The control device according to claim 46, wherein the processor further performs the following operations:
    在所述可移动平台开机时至满足设定条件时的过程中停止触发所述检测所述可移动平台当前所处的所述运动模式的步骤。Stop triggering the step of detecting the motion mode that the movable platform is currently in during the process from when the movable platform is powered on to when a set condition is met.
  48. 根据权利要求47所述的控制装置,其特征在于,所述设定条件包括:The control device according to claim 47, wherein the setting conditions include:
    所述可移动平台开机后的时长达到时长阈值;或The duration of time after the movable platform is powered on reaches the duration threshold; or
    所述可移动平台获取到所述运动模式的选择指令。The movable platform obtains the selection instruction of the motion mode.
  49. 根据权利要求30所述的控制装置,其特征在于,当所述云台由所述跟随模式进入所述增稳模式时,所述处理器还执行如下操作:The control device according to claim 30, wherein when the gimbal enters the stabilization mode from the follow mode, the processor further performs the following operations:
    控制所述增稳模式下所述负载的测量对地姿态为所述跟随模式下所述负载与所述支撑机构的目标相对姿态角对应的目标对地姿态。The measured ground attitude of the load in the stabilization augmentation mode is controlled to be the target ground attitude corresponding to the target relative attitude angle of the load and the support mechanism in the following mode.
  50. 根据权利要求30所述的控制装置,其特征在于,当所述云台由所述增稳模式进入所述跟随模式时,所述处理器还执行如下操作:The control device according to claim 30, wherein when the gimbal enters the following mode from the stabilization mode, the processor further performs the following operations:
    控制所述跟随模式下所述负载与所述支撑机构的测量相对姿态角为所述增稳模式下所述负载的目标对地姿态对应的目标相对姿态角。The measured relative attitude angle of the load and the support mechanism in the following mode is controlled to be the target relative attitude angle corresponding to the target ground attitude of the load in the stabilization mode.
  51. 根据权利要求30所述的控制装置,其特征在于,所述云台处于所述跟随模式时,所述处理器还执行如下操作:The control device according to claim 30, wherein when the pan/tilt head is in the following mode, the processor further performs the following operations:
    确定所述负载与所述支撑机构的目标相对姿态角;determining the target relative attitude angle of the load and the support mechanism;
    获取所述负载与所述支撑机构的测量相对姿态角;obtaining the measured relative attitude angle of the load and the support mechanism;
    根据所述目标相对姿态角以及所述测量相对姿态角控制所述云 台,以保持所述负载与所述支撑机构的相对姿态稳定。The gimbal is controlled according to the target relative attitude angle and the measured relative attitude angle, so as to keep the relative attitude of the load and the support mechanism stable.
  52. 根据权利要求51所述的控制装置,其特征在于,所述处理器还执行如下操作:The control device according to claim 51, wherein the processor further performs the following operations:
    根据所述目标相对姿态角以及所述测量相对姿态角确定所述负载与所述支撑机构间的目标相对姿态角速度;Determine the target relative attitude angular velocity between the load and the support mechanism according to the target relative attitude angle and the measured relative attitude angle;
    获取所述负载与所述支撑机构间的测量相对姿态角速度;obtaining the measured relative attitude angular velocity between the load and the support mechanism;
    根据所述目标相对姿态角速度以及所述测量相对姿态角速度确定所述云台的电机的控制力矩;Determine the control torque of the motor of the gimbal according to the target relative attitude angular velocity and the measured relative attitude angular velocity;
    根据所述控制力矩控制所述电机,以保持所述负载与所述支撑机构的相对姿态稳定。The motor is controlled according to the control torque to keep the relative posture of the load and the support mechanism stable.
  53. 根据权利要求52所述的控制装置,其特征在于,所述处理器还执行如下操作:The control device according to claim 52, wherein the processor further performs the following operations:
    获取所述云台受到的外部扰动,所述外部扰动能够使得所述云台的位置和/或姿态发生变化;Acquiring external disturbances received by the gimbal, the external disturbances can change the position and/or attitude of the gimbal;
    根据所述目标相对姿态角速度、所述测量相对姿态角速度以及所述外部扰动确定所述控制力矩。The control torque is determined according to the target relative attitude angular velocity, the measured relative attitude angular velocity, and the external disturbance.
  54. 根据权利要求30所述的控制装置,其特征在于,所述云台处于所述跟随模式时,所述处理器还执行如下操作:The control device according to claim 30, wherein when the pan/tilt head is in the following mode, the processor further performs the following operations:
    确定所述负载的对地目标姿态角;determining the ground target attitude angle of the payload;
    获取所述负载的对地测量姿态角;obtaining the ground measurement attitude angle of the load;
    根据所述对地目标姿态角以及所述负载的对地测量姿态角控制所述云台,以保持所述负载与所述支撑机构的相对姿态稳定。The gimbal is controlled according to the ground target attitude angle and the ground measurement attitude angle of the load, so as to keep the relative attitude of the load and the support mechanism stable.
  55. 根据权利要求54所述的控制装置,其特征在于,The control device of claim 54, wherein:
    所述负载的对地目标姿态角由所述支撑机构的对地测量姿态角确定。The ground target attitude angle of the load is determined by the ground measurement attitude angle of the support mechanism.
  56. 根据权利要求54所述的控制装置,其特征在于,所述处理器还执行如下操作:The control device according to claim 54, wherein the processor further performs the following operations:
    根据所述对地目标姿态角以及所述负载的对地测量姿态角确定所述负载的对地目标角速度;Determine the ground target angular velocity of the load according to the ground target attitude angle and the ground measurement attitude angle of the load;
    获取所述负载的对地测量角速度;obtaining the ground-measured angular velocity of the load;
    根据所述对地目标角速度以及所述对地测量角速度确定所述云台的电机的控制力矩;Determine the control torque of the motor of the gimbal according to the ground target angular velocity and the ground measurement angular velocity;
    根据所述控制力矩控制所述电机,以保持所述负载与所述支撑机构的相对姿态稳定。The motor is controlled according to the control torque to keep the relative posture of the load and the support mechanism stable.
  57. 根据权利要求56所述的控制装置,其特征在于,所述处理器还执行如下操作:The control device according to claim 56, wherein the processor further performs the following operations:
    获取所述云台受到的外部扰动,所述外部扰动能够使得所述云台的位置和/或姿态发生变化;Acquiring external disturbances received by the gimbal, the external disturbances can change the position and/or attitude of the gimbal;
    根据所述对地目标角速度、所述对地测量角速度以及所述外部扰动确定所述控制力矩。The control torque is determined according to the target angular velocity over the ground, the measured angular velocity over the ground, and the external disturbance.
  58. 一种可移动平台,其特征在于,所述可移动平台包括用于搭载负载的云台以及用于支撑所述云台的支撑机构;所述可移动平台还包括:A movable platform, characterized in that the movable platform comprises a pan-tilt for carrying loads and a support mechanism for supporting the pan-tilt; the movable platform further comprises:
    存储器,用于存储可执行指令;memory for storing executable instructions;
    处理器,用于执行所述存储器中存储的所述可执行指令,以执行如下操作:A processor for executing the executable instructions stored in the memory to perform the following operations:
    获取所述可移动平台当前所处的运动模式,其中,所述可移动平台具有多个运动模式,不同运动模式下的所述可移动平台的控制方式不同;acquiring the motion mode that the movable platform is currently in, wherein the movable platform has multiple motion modes, and the control modes of the movable platform under different motion modes are different;
    根据所述可移动平台的当前所处的所述运动模式,确定所述云台进入相应的云台模式,所述云台模式包括用于保持所述负载的对地姿态稳定的增稳模式、以及用于保持所述负载与所述支撑机构的相对姿态稳定的跟随模式。According to the motion mode that the movable platform is currently in, it is determined that the gimbal enters a corresponding gimbal mode, and the gimbal mode includes a stabilization mode for maintaining a stable attitude of the load to the ground, and a following mode for keeping the relative posture of the load and the support mechanism stable.
  59. 根据权利要求58所述的可移动平台,其特征在于,所述可移动平台还包括定位装置和检测装置,所述定位装置用于获取所述可移动平台的位置信息,所述检测装置用于检测所述可移动平台的周围障碍物信息;The movable platform according to claim 58, wherein the movable platform further comprises a positioning device and a detection device, the positioning device is used for acquiring the position information of the movable platform, and the detection device is used for Detecting the surrounding obstacle information of the movable platform;
    不同运动模式下,所述定位装置和/或所述检测装置的使用状态不同,以使得所述可移动平台具有不同的控制方式。In different motion modes, the positioning device and/or the detection device have different usage states, so that the movable platform has different control modes.
  60. 根据权利要求59所述的可移动平台,其特征在于,所述多个运动模式包括第一运动模式,当所述可移动平台处于所述第一运动模式时,所述定位装置的使用状态为开启,所述检测装置的使用状态为开启所述周围障碍物信息用于所述可移动平台在第一方向以及第二方向上视觉避障的功能;The movable platform according to claim 59, wherein the plurality of motion modes include a first motion mode, and when the movable platform is in the first motion mode, the use state of the positioning device is: On, the use state of the detection device is to enable the function of the surrounding obstacle information for the movable platform to visually avoid obstacles in the first direction and the second direction;
    所述处理器还执行如下操作:The processor also performs the following operations:
    当所述可移动平台的当前所处的所述运动模式为所述第一运动模式时,确定所述云台进入所述增稳模式。When the current motion mode of the movable platform is the first motion mode, it is determined that the gimbal enters the stabilization mode.
  61. 根据权利要求59所述的可移动平台,其特征在于,所述多个运动模式包括第二运动模式,当所述可移动平台处于所述第二运动模式时,所述定位装置的使用状态为开启,所述检测装置的使用状态为开启所述周围障碍物信息用于所述可移动平台在第一方向上视觉避障的功能,并关闭所述周围障碍物信息用于所述可移动平台在第二方向上视觉避障的功能;The movable platform according to claim 59, wherein the plurality of motion modes include a second motion mode, and when the movable platform is in the second motion mode, the use state of the positioning device is: On, the use state of the detection device is to enable the function of the surrounding obstacle information for the movable platform to visually avoid obstacles in the first direction, and turn off the surrounding obstacle information for the movable platform The function of visual obstacle avoidance in the second direction;
    所述处理器还执行如下操作:The processor also performs the following operations:
    当所述可移动平台的当前所处的所述运动模式为所述第二运动模式时,确定所述云台进入所述增稳模式。When the current motion mode of the movable platform is the second motion mode, it is determined that the pan/tilt head enters the stabilization mode.
  62. 根据权利要求59所述的可移动平台,其特征在于,所述多个运动模式包括第三运动模式,当所述可移动平台处于所述第三运动模式时,所述定位装置的使用状态为关闭所述位置信息用于控制所述 可移动平台的位置的功能,所述检测装置的使用状态为关闭所述周围障碍物信息用于所述可移动平台在第一方向以及第二方向上视觉避障的功能;The movable platform according to claim 59, wherein the plurality of motion modes include a third motion mode, and when the movable platform is in the third motion mode, the use state of the positioning device is: Disabling the function of the position information used to control the position of the movable platform, the use state of the detection device is to close the surrounding obstacle information for the movable platform to see in the first direction and the second direction Obstacle avoidance function;
    所述处理器还执行如下操作:The processor also performs the following operations:
    当所述可移动平台的当前所处的所述运动模式为所述第三运动模式时,确定所述云台进入所述跟随模式。When the current motion mode of the movable platform is the third motion mode, it is determined that the pan/tilt head enters the following mode.
  63. 根据权利要求62所述的可移动平台,其特征在于,在所述处理器控制所述云台进入所述跟随模式之前,所述处理器还执行如下操作:The movable platform according to claim 62, wherein before the processor controls the pan/tilt to enter the follow mode, the processor further performs the following operations:
    判断所述可移动平台处于所述第三运动模式的原因;determining the reason why the movable platform is in the third motion mode;
    当所述判断的结果指示所述可移动平台处于所述第三运动模式的原因是响应于用户的输入指令时,则触发所述确定所述云台进入所述跟随模式的步骤。When the result of the judgment indicates that the reason why the movable platform is in the third motion mode is in response to the user's input instruction, the step of determining that the pan/tilt head enters the following mode is triggered.
  64. 根据权利要求63所述的可移动平台,其特征在于,所述处理器还执行如下操作:The movable platform of claim 63, wherein the processor further performs the following operations:
    当所述判断的结果指示所述可移动平台处于所述第三运动模式的原因是所述可移动平台由上一运动模式自动切换到所述第三运动模式时,确定所述云台维持处于所述上一运动模式对应的云台模式。When the result of the judgment indicates that the movable platform is in the third motion mode because the movable platform is automatically switched from the previous motion mode to the third motion mode, it is determined that the gimbal remains in the third motion mode The PTZ mode corresponding to the last motion mode.
  65. 根据权利要求64所述的可移动平台,其特征在于,所述定位装置包括全球定位系统,所述检测装置包括视觉定位系统。65. The movable platform of claim 64, wherein the positioning means comprises a global positioning system and the detection means comprises a visual positioning system.
  66. 根据权利要求65所述的可移动平台,其特征在于,所述可移动平台由上一运动模式自动切换到所述第三运动模式的触发条件包括所述全球定位系统以及所述视觉定位系统的检测信息的可靠性降低。The movable platform according to claim 65, wherein the triggering condition for the movable platform to automatically switch from the previous motion mode to the third motion mode includes the global positioning system and the visual positioning system. The reliability of detection information is reduced.
  67. 根据权利要求66所述的可移动平台,其特征在于,所述处 理器还执行如下操作:The movable platform of claim 66, wherein the processor further performs the following operations:
    当所述全球定位系统的信号低于预设信号阈值时,确定所述全球定位系统的检测信息的可靠性降低。When the signal of the global positioning system is lower than a preset signal threshold, it is determined that the reliability of the detection information of the global positioning system is reduced.
  68. 根据权利要求66所述的可移动平台,其特征在于,所述处理器还执行如下操作:The movable platform of claim 66, wherein the processor further performs the following operations:
    当所述可移动平台周围的光照低于预设亮度阈值时,确定所述视觉定位系统的检测信息的可靠性降低。When the light around the movable platform is lower than a preset brightness threshold, the reliability of determining the detection information of the visual positioning system is reduced.
  69. 根据权利要求59所述的可移动平台,其特征在于,The movable platform of claim 59, wherein:
    所述多个运动模式包括第四运动模式,当所述可移动平台处于所述第四运动模式时,所述定位装置的使用状态为开启,且,所述检测装置的使用状态为关闭所述周围障碍物信息用于所述可移动平台在第一方向以及第二方向上视觉避障的功能;The plurality of motion modes include a fourth motion mode. When the movable platform is in the fourth motion mode, the use state of the positioning device is on, and the use state of the detection device is off. The surrounding obstacle information is used for the visual obstacle avoidance function of the movable platform in the first direction and the second direction;
    所述处理器还执行如下操作:The processor also performs the following operations:
    当所述可移动平台的当前所处的所述运动模式为所述第四运动模式时,确定所述云台进入所述跟随模式。When the current motion mode of the movable platform is the fourth motion mode, it is determined that the pan/tilt head enters the following mode.
  70. 根据权利要求60至69中任一项所述的可移动平台,其特征在于,所述第一方向包括所述可移动平台的竖直方向,所述第二方向包括所述可移动平台的水平方向。The movable platform of any one of claims 60 to 69, wherein the first direction includes a vertical direction of the movable platform, and the second direction includes a horizontal direction of the movable platform direction.
  71. 根据权利要求58所述的可移动平台,其特征在于,所述处理器还执行如下操作:The movable platform of claim 58, wherein the processor further performs the following operations:
    在所述可移动平台根据预设控制指令执行运动操作时,控制所述云台为所述增稳模式。When the movable platform performs a motion operation according to a preset control instruction, the gimbal is controlled to be in the stabilization mode.
  72. 根据权利要求71所述的可移动平台,其特征在于,所述处理器还执行如下操作:The movable platform of claim 71, wherein the processor further performs the following operations:
    在所述可移动平台根据预设控制指令执行运动操作的过程中停 止触发所述检测所述可移动平台当前所处的运动模式的步骤。Stop triggering the step of detecting the motion mode that the movable platform is currently in during the process that the movable platform performs the motion operation according to the preset control instruction.
  73. 根据权利要求71或72所述的可移动平台,其特征在于,所述可移动平台包括飞行器,所述预设控制指令包括返航指令或降落指令。The movable platform according to claim 71 or 72, wherein the movable platform includes an aircraft, and the preset control instruction includes a return home instruction or a landing instruction.
  74. 根据权利要求58所述的可移动平台,其特征在于,所述处理器还执行如下操作:The movable platform of claim 58, wherein the processor further performs the following operations:
    在所述可移动平台开机时,控制所述云台进入所述跟随模式。When the movable platform is powered on, the gimbal is controlled to enter the following mode.
  75. 根据权利要求74所述的可移动平台,其特征在于,所述处理器还执行如下操作:The movable platform of claim 74, wherein the processor further performs the following operations:
    在所述可移动平台开机时至满足设定条件时的过程中停止触发所述检测所述可移动平台当前所处的所述运动模式的步骤。Stop triggering the step of detecting the motion mode that the movable platform is currently in during the process from when the movable platform is powered on to when a set condition is met.
  76. 根据权利要求75所述的可移动平台,其特征在于,所述设定条件包括:The movable platform according to claim 75, wherein the setting conditions include:
    所述可移动平台开机后的时长达到时长阈值;或The duration of time after the movable platform is powered on reaches the duration threshold; or
    所述可移动平台获取到所述运动模式的选择指令。The movable platform obtains the selection instruction of the motion mode.
  77. 根据权利要求58所述的可移动平台,其特征在于,当所述云台由所述跟随模式进入所述增稳模式时,所述处理器还执行如下操作:The movable platform according to claim 58, wherein when the gimbal enters the stabilization mode from the follow mode, the processor further performs the following operations:
    控制所述增稳模式下所述负载的测量对地姿态为所述跟随模式下所述负载与所述支撑机构的目标相对姿态角对应的目标对地姿态。The measured ground attitude of the load in the stabilization augmentation mode is controlled to be the target ground attitude corresponding to the target relative attitude angle of the load and the support mechanism in the following mode.
  78. 根据权利要求58所述的可移动平台,其特征在于,当所述云台由所述增稳模式进入所述跟随模式时,所述处理器还执行如下操作:The movable platform according to claim 58, wherein when the gimbal enters the following mode from the stabilization mode, the processor further performs the following operations:
    控制所述跟随模式下所述负载与所述支撑机构的测量相对姿态 角为所述增稳模式下所述负载的目标对地姿态对应的目标相对姿态角。The measured relative attitude angle of the load and the support mechanism in the following mode is controlled to be the target relative attitude angle corresponding to the target ground attitude of the load in the stabilization mode.
  79. 根据权利要求58所述的可移动平台,其特征在于,所述云台处于所述跟随模式时,所述处理器还执行如下操作:The movable platform according to claim 58, wherein when the pan/tilt head is in the following mode, the processor further performs the following operations:
    确定所述负载与所述支撑机构的目标相对姿态角;determining the target relative attitude angle of the load and the support mechanism;
    获取所述负载与所述支撑机构的测量相对姿态角;obtaining the measured relative attitude angle of the load and the support mechanism;
    根据所述目标相对姿态角以及所述测量相对姿态角控制所述云台,以保持所述负载与所述支撑机构的相对姿态稳定。The gimbal is controlled according to the target relative attitude angle and the measured relative attitude angle, so as to keep the relative attitude of the load and the support mechanism stable.
  80. 根据权利要求79所述的可移动平台,其特征在于,所述处理器还执行如下操作:The movable platform of claim 79, wherein the processor further performs the following operations:
    根据所述目标相对姿态角以及所述测量相对姿态角确定所述负载与所述支撑机构间的目标相对姿态角速度;Determine the target relative attitude angular velocity between the load and the support mechanism according to the target relative attitude angle and the measured relative attitude angle;
    获取所述负载与所述支撑机构间的测量相对姿态角速度;obtaining the measured relative attitude angular velocity between the load and the support mechanism;
    根据所述目标相对姿态角速度以及所述测量相对姿态角速度确定所述云台的电机的控制力矩;Determine the control torque of the motor of the gimbal according to the target relative attitude angular velocity and the measured relative attitude angular velocity;
    根据所述控制力矩控制所述电机,以保持所述负载与所述支撑机构的相对姿态稳定。The motor is controlled according to the control torque to keep the relative posture of the load and the support mechanism stable.
  81. 根据权利要求80所述的可移动平台,其特征在于,所述处理器还执行如下操作:The movable platform of claim 80, wherein the processor further performs the following operations:
    获取所述云台受到的外部扰动,所述外部扰动能够使得所述云台的位置和/或姿态发生变化;Acquiring external disturbances received by the gimbal, where the external disturbances can change the position and/or attitude of the gimbal;
    根据所述目标相对姿态角速度、所述测量相对姿态角速度以及所述外部扰动确定所述控制力矩。The control torque is determined according to the target relative attitude angular velocity, the measured relative attitude angular velocity, and the external disturbance.
  82. 根据权利要求58所述的可移动平台,其特征在于,所述云台处于所述跟随模式时,所述处理器还执行如下操作:The movable platform according to claim 58, wherein when the pan/tilt head is in the following mode, the processor further performs the following operations:
    确定所述负载的对地目标姿态角;determining the ground target attitude angle of the payload;
    获取所述负载的对地测量姿态角;obtaining the ground measurement attitude angle of the load;
    根据所述对地目标姿态角以及所述负载的对地测量姿态角控制所述云台,以保持所述负载与所述支撑机构的相对姿态稳定。The gimbal is controlled according to the ground target attitude angle and the ground measurement attitude angle of the load, so as to keep the relative attitude of the load and the support mechanism stable.
  83. 根据权利要求82所述的可移动平台,其特征在于,The movable platform of claim 82, wherein:
    所述负载的对地目标姿态角由所述支撑机构的对地测量姿态角确定。The ground target attitude angle of the load is determined by the ground measurement attitude angle of the support mechanism.
  84. 根据权利要求82所述的可移动平台,其特征在于,所述处理器还执行如下操作:The movable platform of claim 82, wherein the processor further performs the following operations:
    根据所述对地目标姿态角以及所述负载的对地测量姿态角确定所述负载的对地目标角速度;Determine the ground target angular velocity of the load according to the ground target attitude angle and the ground measurement attitude angle of the load;
    获取所述负载的对地测量角速度;obtaining the ground-measured angular velocity of the load;
    根据所述对地目标角速度以及所述对地测量角速度确定所述云台的电机的控制力矩;Determine the control torque of the motor of the gimbal according to the target angular velocity towards the ground and the measured angular velocity towards the ground;
    根据所述控制力矩控制所述电机,以保持所述负载与所述支撑机构的相对姿态稳定。The motor is controlled according to the control torque to keep the relative posture of the load and the support mechanism stable.
  85. 根据权利要求84所述的可移动平台,其特征在于,所述处理器还执行如下操作:The movable platform of claim 84, wherein the processor further performs the following operations:
    获取所述云台受到的外部扰动,所述外部扰动能够使得所述云台的位置和/或姿态发生变化;Acquiring external disturbances received by the gimbal, where the external disturbances can change the position and/or attitude of the gimbal;
    根据所述对地目标角速度、所述对地测量角速度以及所述外部扰动确定所述控制力矩。The control torque is determined according to the target angular velocity over the ground, the measured angular velocity over the ground, and the external disturbance.
  86. 一种可移动平台组件,其特征在于,包括:A movable platform assembly, characterized in that it includes:
    权利要求58至85中任一项所述的可移动平台;The movable platform of any one of claims 58 to 85;
    遥控终端,所述遥控终端与所述可移动平台通信连接,用于控制所述可移动平台,其中,所述可移动平台的运动模式能够通过所述遥控终端进行切换。A remote control terminal, which is connected in communication with the movable platform and used to control the movable platform, wherein the movement mode of the movable platform can be switched by the remote control terminal.
PCT/CN2020/139528 2020-12-25 2020-12-25 Movable platform and control method and device therefor WO2022134036A1 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/CN2020/139528 WO2022134036A1 (en) 2020-12-25 2020-12-25 Movable platform and control method and device therefor
CN202080073976.5A CN114641746A (en) 2020-12-25 2020-12-25 Movable platform and control method and device thereof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2020/139528 WO2022134036A1 (en) 2020-12-25 2020-12-25 Movable platform and control method and device therefor

Publications (1)

Publication Number Publication Date
WO2022134036A1 true WO2022134036A1 (en) 2022-06-30

Family

ID=81945260

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2020/139528 WO2022134036A1 (en) 2020-12-25 2020-12-25 Movable platform and control method and device therefor

Country Status (2)

Country Link
CN (1) CN114641746A (en)
WO (1) WO2022134036A1 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115686053B (en) * 2023-01-04 2023-04-18 北京航科京工科技有限责任公司 Load attitude adjusting device and method

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016011590A1 (en) * 2014-07-21 2016-01-28 深圳市大疆创新科技有限公司 Data processing method and device, and aircraft
CN109074087A (en) * 2017-12-25 2018-12-21 深圳市大疆创新科技有限公司 Yaw attitude control method, unmanned plane, computer readable storage medium
CN109071034A (en) * 2017-12-27 2018-12-21 深圳市大疆创新科技有限公司 Switch method, controller and the image stability augmentation equipment of holder operating mode
CN109343553A (en) * 2018-10-30 2019-02-15 佛山市神风航空科技有限公司 A kind of no medicine makes a return voyage unmanned plane automatically
CN110869283A (en) * 2018-08-30 2020-03-06 深圳市大疆创新科技有限公司 Control method and device of cloud deck, cloud deck system and unmanned aerial vehicle
CN111309053A (en) * 2020-05-15 2020-06-19 南京嘉谷初成通信科技有限公司 Unmanned aerial vehicle control method, unmanned aerial vehicle return control method, unmanned aerial vehicle, medium and control system

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016011590A1 (en) * 2014-07-21 2016-01-28 深圳市大疆创新科技有限公司 Data processing method and device, and aircraft
CN109074087A (en) * 2017-12-25 2018-12-21 深圳市大疆创新科技有限公司 Yaw attitude control method, unmanned plane, computer readable storage medium
CN109071034A (en) * 2017-12-27 2018-12-21 深圳市大疆创新科技有限公司 Switch method, controller and the image stability augmentation equipment of holder operating mode
CN110869283A (en) * 2018-08-30 2020-03-06 深圳市大疆创新科技有限公司 Control method and device of cloud deck, cloud deck system and unmanned aerial vehicle
CN109343553A (en) * 2018-10-30 2019-02-15 佛山市神风航空科技有限公司 A kind of no medicine makes a return voyage unmanned plane automatically
CN111309053A (en) * 2020-05-15 2020-06-19 南京嘉谷初成通信科技有限公司 Unmanned aerial vehicle control method, unmanned aerial vehicle return control method, unmanned aerial vehicle, medium and control system

Also Published As

Publication number Publication date
CN114641746A (en) 2022-06-17

Similar Documents

Publication Publication Date Title
WO2019223271A1 (en) Correction method and device for yaw of aircraft, and aircraft
WO2019223270A1 (en) Method and apparatus for estimating angle and angular velocity of electric motor of gimbal, and gimbal and aerial vehicle
US10447912B2 (en) Systems, methods, and devices for setting camera parameters
JP6234679B2 (en) Maneuvering method of a rotary wing drone to take a picture with an onboard camera while minimizing the movement that causes disturbance
WO2018098784A1 (en) Unmanned aerial vehicle controlling method, device, equipment and unmanned aerial vehicle controlling system
WO2018098704A1 (en) Control method, apparatus, and system, unmanned aerial vehicle, and mobile platform
CN110347171B (en) Aircraft control method and aircraft
WO2018053877A1 (en) Control method, control device, and delivery system
WO2018058320A1 (en) Method and apparatus for controlling unmanned aerial vehicle
WO2018073879A1 (en) Flight route generation method, flight route generation system, flight vehicle, program, and recording medium
WO2021078165A1 (en) Flight control method and apparatus for unmanned aerial vehicle, and unmanned aerial vehicle and storage medium
WO2019126958A1 (en) Yaw attitude control method, unmanned aerial vehicle, and computer readable storage medium
JP2009173263A (en) Method and system for autonomous tracking of mobile target by unmanned aerial vehicle (uav)
US11272105B2 (en) Image stabilization control method, photographing device and mobile platform
CN110716579B (en) Target tracking method and unmanned aerial vehicle
CN110377058B (en) Aircraft yaw angle correction method and device and aircraft
WO2021052334A1 (en) Return method and device for unmanned aerial vehicle, and unmanned aerial vehicle
WO2017181513A1 (en) Flight control method and device for unmanned aerial vehicle
WO2020042064A1 (en) Cradle head control method and device, cradle head system and unmanned aerial vehicle
WO2020048365A1 (en) Flight control method and device for aircraft, and terminal device and flight control system
CN111897356A (en) Obstacle avoidance method and device and unmanned aerial vehicle
CN114578841A (en) Unmanned aerial vehicle and holder control method thereof
WO2022134036A1 (en) Movable platform and control method and device therefor
TWI709011B (en) Method for calculating and controlling UAV heading
WO2020042159A1 (en) Rotation control method and apparatus for gimbal, control device, and mobile platform

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 20966601

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 20966601

Country of ref document: EP

Kind code of ref document: A1