Control method and device of electric holder
Through the closed-loop control of the electric gimbal, the damping and dynamic balance problems of mechanical structure gimbal under the influence of environmental factors are solved, and stable and precise driving under different conditions is achieved, which improves the use effect.
Patent Information
- Application Number
- CN202411079415.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-08-06
- Publication Date
- 2024-11-22
AI Technical Summary
Under the influence of environmental factors, the damping and dynamic equilibrium of the mechanical structure is affected, affecting the use effect.
The electric gimbal is used and closed-loop control is performed by obtaining the gimbal parameter information, including position closed-loop, speed closed-loop and current closed-loop. The driving motor is adjusted to achieve precise driving and adapt to different environmental conditions.
Through closed-loop control, the electric gimbal can maintain stability and accuracy under different environmental conditions, improving the user experience and dynamic balance performance of the equipment.
Smart Images

Figure CN119002559A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of electric pan-tilt platforms, and in particular to a control method and device for an electric pan-tilt platform. Background Art
[0002] The gimbal is a supporting device for users during filming. It can be used to install and fix shooting equipment such as mobile phones, cameras and camcorders, so as to help users shoot clear videos. It is suitable for users to carry shooting equipment for sports and travel. Regarding the use of the gimbal, usually the tripod is set up first, and then the equipment is installed and tightened to adjust the gimbal damping. Achieve dynamic balance. When panning, if the handle is released, it can rebound to the original position.
[0003] Commonly used gimbals are mechanical structures and are affected by environmental factors during the shooting process, such as temperature, air pressure and other environmental factors. At this time, the damping or dynamic balance of the gimbal will be affected by the weather, which will also affect the use of the gimbal. Summary of the invention
[0004] The main technical problem solved by the present invention is that the damping or dynamic balance of a pan / tilt platform including a mechanical structure may be affected by environmental factors, thereby affecting the use of the pan / tilt platform.
[0005] According to a first aspect, an embodiment provides a control method of an electric pan-tilt platform, which is applied to an electric pan-tilt platform including a driving motor, wherein the electric pan-tilt platform is used to support a target object, and includes:
[0006] When a pan / tilt rotation instruction is received, obtaining pan / tilt parameter information of the electric pan / tilt;
[0007] Based on the pan / tilt parameter information, closed-loop control of the drive motor is completed to control the electric pan / tilt; the closed-loop control includes at least one of a position closed-loop, a speed closed-loop, and a current closed-loop.
[0008] In some embodiments, before receiving the pan / tilt rotation instruction, the control method includes:
[0009] Determine the required PTZ control mode;
[0010] Based on the gimbal control mode, a corresponding closed-loop control is determined to control the drive motor, thereby adjusting the corresponding function of the gimbal.
[0011] In some embodiments, the driving motor includes a damping motor and / or a dynamic balancing motor, and the gimbal control mode includes a first control mode and / or a second control mode, wherein determining the corresponding closed-loop control based on the gimbal control mode to control the driving motor, thereby adjusting the corresponding function of the gimbal includes:
[0012] When the pan / tilt control mode is in the first control mode, controlling the drive motor in at least one of a speed closed loop, a current closed loop, and a position closed loop;
[0013] When the pan / tilt control mode is in the second control mode, the drive motor is controlled to be at least in a position closed loop.
[0014] In some embodiments, if the required gimbal control mode is the first control mode, when the gimbal control mode is the first control mode, controlling the drive motor in at least one of a speed closed loop, a current closed loop, and a position closed loop includes:
[0015] Determine the pan / tilt function that needs to be adjusted, and determine the corresponding closed-loop control based on the pan / tilt function that needs to be adjusted to drive the drive motor, thereby adjusting the corresponding function.
[0016] In some embodiments, if the gimbal function that needs to be adjusted is damping adjustment, determining the gimbal function that needs to be adjusted, and controlling the drive motor based on the closed-loop control corresponding to the gimbal function that needs to be adjusted to adjust the corresponding gimbal function, includes:
[0017] Controlling the drive motor in the speed closed loop;
[0018] Based on the gimbal parameter information, the driving motor is controlled to complete closed-loop speed regulation to adjust the corresponding gimbal damping function; wherein the gimbal parameter information is a target speed; or,
[0019] Control the drive motor in a three-closed-loop control mode of the speed closed loop, the position closed loop and the current closed loop;
[0020] The three closed-loop control modes are input according to the gimbal parameter information to perform closed-loop adjustment to adjust the gimbal damping function, wherein the gimbal parameter information is the target speed.
[0021] In some embodiments, if the gimbal function that needs to be adjusted is dynamic balance adjustment, determining the gimbal function that needs to be adjusted, and controlling the drive motor based on the closed-loop control corresponding to the gimbal function that needs to be adjusted to adjust the corresponding function of the gimbal, includes:
[0022] Controlling the driving motor in the current closed loop;
[0023] Based on the gimbal parameter information, the driving motor is controlled to complete current closed-loop regulation to adjust the corresponding dynamic balancing function, wherein the gimbal parameter information is a target current; or
[0024] Controlling the driving motor to close the loop at the position;
[0025] Based on the gimbal parameter information, the driving motor is controlled to complete position closed-loop adjustment to adjust the dynamic balance function of the gimbal, wherein the gimbal parameter information is the target position; or
[0026] Control the drive motor to sequentially perform three closed-loop control of the position closed-loop, the speed closed-loop and the current closed-loop;
[0027] The driving motor is controlled based on the gimbal parameter information to complete the three-closed-loop control to adjust the dynamic balance function of the gimbal, wherein the gimbal parameter information is the target position.
[0028] In some embodiments, if it is determined that the gimbal control mode is the second control mode, when the gimbal control mode is the second control mode, controlling the drive motor at least in a position closed loop further includes:
[0029] Controlling the drive motor in position closed loop, speed closed loop and current closed loop;
[0030] The driving motor is controlled based on the gimbal parameter information to complete the position closed-loop control adjustment to adjust the dynamic balance function of the gimbal, wherein the gimbal parameter information at least includes a target position.
[0031] In some embodiments, when a pan / tilt rotation instruction is received, obtaining pan / tilt parameter information of the electric pan / tilt includes:
[0032] When receiving a pan / tilt rotation instruction, determining a control mode corresponding to the electric pan / tilt;
[0033] When the electric pan-tilt platform is in the first control mode, receiving pan-tilt platform parameter information when the user manually operates the electric pan-tilt platform;
[0034] When the electric pan / tilt platform is in the second control mode, an adjustment instruction packet from the control end is received and parsed to extract pan / tilt parameter information in the adjustment instruction packet.
[0035] In some embodiments, when the electric pan / tilt platform is in the second control mode, the method further includes:
[0036] Establish a communication connection between a preset remote control module and the electric pan-tilt head, and when an operation signal sent by the remote control module is received, perform closed-loop control of the drive motor based on the pan-tilt head parameter information to control the electric pan-tilt head; wherein the operation signal includes a signal generated by controlling the joystick handle in the remote control module or a signal generated by performing a touch screen operation on the remote control module.
[0037] According to a second aspect, an embodiment provides a control device for an electric pan-tilt platform, which is applied to an electric pan-tilt platform including a driving motor, wherein the electric pan-tilt platform is used to support a target object, and includes:
[0038] A parameter acquisition module, used for acquiring pan / tilt parameter information of the electric pan / tilt when receiving a pan / tilt rotation instruction;
[0039] The gimbal control module is used to complete the closed-loop control of the drive motor based on the gimbal parameter information to control the electric gimbal; the closed-loop control includes at least one of a position closed loop, a speed closed loop and a current closed loop.
[0040] According to the control method and device of the electric pan-tilt head of the above-mentioned embodiment, the pan-tilt parameter information of the electric pan-tilt head is obtained when the pan-tilt head rotation command is received, and the drive motor is closed-loop controlled based on the pan-tilt parameter information to control the electric pan-tilt head. Since the closed-loop control includes at least one of the position closed-loop, speed closed-loop and current closed-loop, the drive motor can be precisely driven through different closed-loop controls to control the electric pan-tilt head. BRIEF DESCRIPTION OF THE DRAWINGS
[0041] Figure 1 This is a control flow chart of the electric pan / tilt platform according to an embodiment of the present application;
[0042] Figure 2 A control flow chart of an electric pan / tilt platform according to an embodiment;
[0043] Figure 3 A reference calculation block diagram of PID calculation of an embodiment;
[0044] Figure 4 A reference frame diagram of a three-closed-loop control of an embodiment;
[0045] Figure 5 A schematic diagram of calculation of three closed-loop control of an embodiment;
[0046] Figure 6 The present invention is a schematic structural diagram of a control device of an electric pan / tilt platform according to an embodiment. DETAILED DESCRIPTION
[0047] The present invention is further described in detail below by specific embodiments in conjunction with the accompanying drawings. Wherein similar elements in different embodiments adopt associated similar element numbers. In the following embodiments, many detailed descriptions are for making the present application better understood. However, those skilled in the art can easily recognize that some features can be omitted in different situations, or can be replaced by other elements, materials, methods. In some cases, some operations related to the present application are not shown or described in the specification, this is to avoid the core part of the present application being overwhelmed by too much description, and for those skilled in the art, it is not necessary to describe these related operations in detail, and they can fully understand the related operations according to the description in the specification and the general technical knowledge in the art.
[0048] In addition, the features, operations or characteristics described in the specification can be combined in any appropriate manner to form various implementations. At the same time, the steps or actions in the method description can also be interchanged or adjusted in a manner that is obvious to those skilled in the art. Therefore, the various sequences in the specification and the drawings are only for the purpose of clearly describing a certain embodiment and are not meant to be a required sequence, unless otherwise specified that a certain sequence must be followed.
[0049] The serial numbers of the components in this document, such as "first", "second", etc., are only used to distinguish the objects described and do not have any order or technical meaning. The "connection" and "coupling" mentioned in this application, unless otherwise specified, include direct and indirect connections (couplings).
[0050] Please refer to Figure 1 In an embodiment of the present invention, a control method for an electric pan-tilt platform is provided, which is applied to an electric pan-tilt platform including a driving motor, wherein the electric pan-tilt platform is used to support a target object. The control method includes steps S10 to S20, which are described in detail below.
[0051] Step S10: When a pan / tilt rotation instruction is received, the pan / tilt parameter information of the electric pan / tilt is obtained.
[0052] Please refer to Figure 2 In some embodiments, when a pan / tilt rotation instruction is received, the pan / tilt parameter information of the electric pan / tilt is obtained, including steps S11 to S13, which are described in detail below.
[0053] Step S11: before receiving the pan / tilt rotation instruction, first determine the control mode corresponding to the electric pan / tilt.
[0054] In some embodiments, the electric pan-tilt head includes a drive motor, which can replace the mechanical structure in the pan-tilt head to achieve load control. The electric pan-tilt head includes two control modes, namely a first control mode and a second control mode, wherein the first control mode is a main control mode, that is, the electric pan-tilt head is controlled by a main control module, and the second control mode is a passive mode, that is, the electric pan-tilt head is controlled according to the received instructions. When a pan-tilt head rotation instruction is received, it is necessary to first determine which control mode the electric pan-tilt head corresponds to. It is worth noting that the first control mode and the second control mode can be pre-set. For example, the user can set the first control mode and the second control mode in the UI interface of the pan-tilt head, and the main control module of the pan-tilt head can determine the current pan-tilt head control mode according to the user's settings.
[0055] Step S12: When the electric pan / tilt head is in the first control mode, receiving pan / tilt head parameter information when the user manually operates the electric pan / tilt head.
[0056] In some embodiments, when the electric pan-tilt is in the first control mode, that is, in the master control mode, the main control module can receive the pan-tilt parameter information of the user when operating the electric pan-tilt. Among them, the master control mode can be understood as a mode in which the user simulates the mechanical structure state, that is, simulates the feel of the user operating the pure mechanical structure pan-tilt, which is suitable for the scenario where the user performs manual operation. The user rotates the electric pan-tilt in the direction or pitches the pan-tilt through the tripod handle. During this operation, when the main control module receives the pan-tilt rotation instruction, it will receive the pan-tilt parameter information of the user when operating the electric pan-tilt. Among them, the pan-tilt parameter information includes the target speed, target position and target current. In the master control mode, the pan-tilt target speed is 0, the target position is the current position, and the target current can be calculated based on the load, combined with the moment balance and trigonometric function. Since the drive motor includes a damping motor and / or a dynamic balancing motor, and the damping motor can include a horizontal damping motor and a pitch damping motor, when the dynamic balancing motor in the drive motor is adjusted, the pan-tilt parameter information can be the target current.
[0057] Step S13: When the electric pan / tilt head is in the second control mode, an adjustment instruction packet from the control end is received and parsed to extract pan / tilt head parameter information from the adjustment instruction packet.
[0058] In some embodiments, when the electric gimbal is in the second control mode, that is, in the passive mode, the main control module receives the adjustment instruction packet and parses it. Since the adjustment instruction packet includes heading adjustment data, pitch adjustment data and a verification code, the adjustment instruction packet will be parsed first. The data in the adjustment instruction packet can be parsed according to a predefined communication protocol. For example, the communication protocol can define n bytes as heading adjustment data, and another m bytes as pitch adjustment data. The main control module can obtain accurate adjustment instructions after parsing according to the communication protocol. In addition, the verification code in the adjustment instruction packet can also be verified. When the verification passes, the gimbal parameter information in the adjustment instruction packet is extracted. Among them, in the passive mode, the gimbal parameter information includes the target position and may also include the target speed.
[0059] In some embodiments, when the electric pan-tilt head is in the second control mode, a communication connection between the remote control module and the electric pan-tilt head will also be established, wherein the main control module can be connected to a remote control module by wire or wirelessly, and the remote control module has a joystick handle or an attached screen response, and the electric pan-tilt head can be controlled by receiving the swing of the joystick or performing touch screen operation on the screen. At this time, when the electric pan-tilt head is in the second control mode, its pan-tilt parameter information is obtained by the user through the operating handle, and at least one rotation angle needs to be given first, and the speed and current can also be provided auxiliary. For example, when the rotation angle is 270°, the auxiliary speed and current at this time can be understood as the auxiliary speed and current corresponding to the rotation of the electric pan-tilt head to 270°. For example, the remote control module can be connected to the main control module of the electric pan-tilt head by 2.4G wireless.
[0060] In some embodiments, when the electric pan-tilt head is in the second control mode, the pitch axis of the electric pan-tilt head may also include a spare pitch motor, which will be consistent with the pre-set working mechanism of the pitch motor when pitch-related work is required.
[0061] Step S20: completing closed-loop control of the drive motor based on the pan / tilt parameter information to control the electric pan / tilt; the closed-loop control includes at least one of a position closed-loop, a speed closed-loop, and a current closed-loop.
[0062] In some embodiments, the required gimbal control mode is first determined, and the closed-loop control of the drive motor is determined according to the gimbal control mode, so as to adjust the corresponding function of the gimbal. Among them, the drive motor includes a damping motor and / or a dynamic balancing motor, and the damping motor includes horizontal damping and pitch damping, so that the electric gimbal can also simulate the operating feel of a pure mechanical gimbal, such as damping operating feel, force operating feel or rebound operating feel, etc. The gimbal control mode includes a first control mode and / or a second control mode. Among them, the first control mode and the second control mode here correspond to the first control mode in step S12 and the second control mode in step S13, respectively, and can refer to an active control mode and a passive mode, respectively.
[0063] In some embodiments, when the pan / tilt control mode is in the first control mode, the drive motor is controlled in at least one of the speed closed loop, the current closed loop and the position closed loop, and the pan / tilt function that needs to be adjusted is determined. Based on the pan / tilt function that needs to be adjusted, the corresponding closed loop control is completed to realize the driving of the drive motor, thereby adjusting the corresponding function, and further simulating the damping and dynamic balance operation feeling of the user turning the pan / tilt when the pan / tilt is a pure mechanical damping structure and a mechanical dynamic balance structure. Among them, if the pan / tilt function that needs to be adjusted is damping adjustment, the drive motor is controlled in the speed closed loop, and the drive motor is controlled to complete the speed closed loop adjustment according to the pan / tilt parameter information to adjust the corresponding pan / tilt damping function, and the pan / tilt parameter information is the target speed at this time. Alternatively, the drive motor is controlled in the three closed loop control modes of speed closed loop, position closed loop and current closed loop, and the three closed loop control modes are input according to the pan / tilt parameter information for closed loop adjustment to adjust the pan / tilt damping function, and the pan / tilt parameter information at this time is also the target speed. Among them, the target speed is 0.
[0064] In some embodiments, when controlling the drive motor in a speed closed loop, the speed closed loop specifically calculates the initial speed based on the target speed and a preset PID algorithm, and calculates the error value corresponding to the initial speed and the target speed. The preset number of rounds of iterative calculations are performed based on the error value and the PID algorithm, and the drive motor is controlled to complete the speed closed loop adjustment based on the rotation speed obtained by the iterative calculation.
[0065] In some embodiments, the initial speed is calculated based on the target speed and the PID (Proportion Integral Differential) algorithm. At this time, there will be an error value between the calculated initial speed and the target speed. In the first control mode, the target speed is 0 at the beginning, so as to simulate the state when the user initially turns the handle. In the second control mode, the target speed is the speed sent by the handle.
[0066] Please refer to Figure 3In some embodiments, a preset number of iterative calculations are performed according to the error value and the PID algorithm, that is, the output speed calculated according to the error value and the PID algorithm is used as the input speed in the next round of calculation, that is, the preset value in the next round of PID calculation, so as to continuously refresh and continuously generate output values as parameter information. Among them, the calculated output value can also be fed back to the next round of PID calculation through a sensor.
[0067] Please refer to Figure 4 In some embodiments, the electric pan / tilt head is controlled by controlling the driving motor in a three-closed-loop control mode of speed closed loop, position closed loop and current closed loop. The three-closed-loop control mode is based on speed closed loop, and position closed loop and current closed loop are used as auxiliary. In the three-closed-loop control mode, the speed closed loop, position closed loop and current closed loop are constantly calculated and updated. Therefore, the parameter information and the corresponding target position and target current will be refreshed in real time to ensure the smoothness of the rotation. At the same time, the auxiliary speed closed loop and current closed loop are used to assist the user in maintaining a uniform speed or force during the rotation process, thereby improving the user's experience.
[0068] In some embodiments, when the gimbal control mode is in the first control mode, the drive motor is controlled in at least one of the speed closed loop, the current closed loop and the position closed loop, and the gimbal function that needs to be adjusted is determined, and the corresponding closed loop control is completed based on the gimbal function that needs to be adjusted to achieve the drive of the drive motor, thereby adjusting the corresponding function. Among them, if the gimbal function that needs to be adjusted is dynamic balance adjustment, the drive motor is controlled in the current closed loop, and the drive motor is controlled to complete the current closed loop adjustment according to the gimbal parameter information to adjust the corresponding dynamic balance function. At this time, the gimbal parameter information is the target current. When the gimbal function that needs to be adjusted is dynamic balance adjustment, the drive motor can also be controlled in the position closed loop, and the drive motor is controlled to complete the position closed loop adjustment based on the gimbal parameter information to adjust the dynamic balance function of the gimbal. At this time, the gimbal parameter information is the target position. When the gimbal function that needs to be adjusted is dynamic balance adjustment, the drive motor can also be controlled in sequence to perform three closed-loop controls of position closed-loop, speed closed-loop and current closed-loop. Based on the gimbal parameter information, the drive motor is controlled to complete the three closed-loop control to adjust the dynamic balance function of the gimbal. At this time, the gimbal parameter information is the target position.
[0069] In some embodiments, when the gimbal control mode is in the second control mode, the control drive motor is at least in a position closed loop, which may include controlling the drive motor in a position closed loop, and may also include controlling the drive motor in a position closed loop, a speed closed loop, and a current closed loop, and the drive motor is controlled based on the gimbal parameter information to complete the position closed loop control adjustment, so as to adjust the dynamic balance function of the gimbal, wherein the gimbal parameter information includes at least the target position. Since the second control mode is a passive control mode, it can be achieved by means of a remote control handle. Therefore, the remote control handle will also send the rotation angle, that is, the target position, or the auxiliary speed and current at the same time, indicating the expected control angle of the electric gimbal, and the speed and force to assist in achieving it.
[0070] Please refer to Figure 5 In some embodiments, when the driving motor is controlled in the three closed loops of position closed loop, speed closed loop and current closed loop in sequence, the force of the load acting on the driving motor is received, and the corresponding rotation position is obtained according to the force. The expected speed is calculated according to the rotation position closed loop, and the expected current is further calculated. According to the current closed loop calculation, the corresponding force is output to drive the driving motor, and the driving motor will rotate to the actual rotation position, thereby achieving dynamic balance. It can be understood that in the above process as a cyclic process, the position, speed and current value feedback can be collected by the sensor and the next round of calculation can be performed to achieve the precise control of the position, speed and force of the electric pan-tilt during the rotation process, and the control stability can be achieved. Among them, the current value in the motor can be sampled by the current, and returned to the calculation before the current closed loop, and the PID calculation in the current closed loop can be re-performed in combination with the sampled current value. The motor speed at the actual rotation position will also have an encoder change value. The motor speed at this time can be returned to the speed loop calculation before the speed loop calculation, and the PID calculation in the speed closed loop can be re-performed in combination with the motor speed. Similarly, there is an encoder accumulated value between the electrode rotation position and the actual rotation position. The motor rotation position is returned to before the position closed loop calculation, and the PID calculation in the position closed loop is re-performed in combination with the motor rotation position.
[0071] In some embodiments, a display screen is also provided on the electric pan-tilt head, and the display screen can display the received content to be displayed. At the same time, the electric pan-tilt head also includes a horizontal damping adjustment knob, a pitch damping adjustment knob, and a dynamic balance adjustment knob, and the horizontal damping adjustment knob, the pitch damping adjustment knob, and the dynamic balance adjustment knob are adjusted according to the received user needs, wherein the user needs can be the received damping gear and dynamic balance gear parameters. In this way, the damping and load-bearing capacity during the rotation process are adjusted.
[0072] Please refer to Figure 6In an embodiment of the present invention, a control device for an electric pan-tilt platform is provided, which is applied to an electric pan-tilt platform including a driving motor, wherein the electric pan-tilt platform is used to support a target object, and includes a parameter acquisition module 10 and a pan-tilt platform control module 20, which are described in detail below.
[0073] When receiving the pan / tilt rotation instruction, the parameter acquisition module 10 acquires the pan / tilt parameter information of the electric pan / tilt.
[0074] Please refer back to Figure 2 In some embodiments, when a pan / tilt rotation instruction is received, pan / tilt parameter information of the electric pan / tilt is obtained, as described in detail below.
[0075] Before receiving the pan / tilt rotation instruction, the parameter acquisition module 10 first determines the control mode corresponding to the electric pan / tilt. When the electric pan / tilt is in the first control mode, the pan / tilt parameter information when the user manually operates the electric pan / tilt is received. When the electric pan / tilt is in the second control mode, the adjustment instruction packet from the control end is received and parsed, and the pan / tilt parameter information in the adjustment instruction packet is extracted.
[0076] In some embodiments, the electric pan-tilt head includes a drive motor, which can replace the mechanical structure in the pan-tilt head to achieve load control. The electric pan-tilt head includes two control modes, namely a first control mode and a second control mode, wherein the first control mode is a main control mode, that is, the electric pan-tilt head is controlled by a main control module, and the second control mode is a passive mode, that is, the electric pan-tilt head is controlled according to the received instructions. When a pan-tilt head rotation instruction is received, it is necessary to first determine which control mode the electric pan-tilt head corresponds to. It is worth noting that the first control mode and the second control mode can be pre-set. For example, the user can set the first control mode and the second control mode in the UI interface of the pan-tilt head, and the main control module of the pan-tilt head can determine the current pan-tilt head control mode according to the user's settings.
[0077] In some embodiments, when the electric pan-tilt is in the first control mode, that is, in the master control mode, the main control module can receive the pan-tilt parameter information of the user when operating the electric pan-tilt. Among them, the master control mode can be understood as a mode in which the user simulates the mechanical structure state, that is, simulates the feel of the user operating the pure mechanical structure pan-tilt, which is suitable for the scenario where the user performs manual operation. The user rotates the electric pan-tilt in the direction or pitches the pan-tilt through the tripod handle. During this operation, when the main control module receives the pan-tilt rotation instruction, it will receive the pan-tilt parameter information of the user when operating the electric pan-tilt. Among them, the pan-tilt parameter information includes the target speed, target position and target current. In the master control mode, the pan-tilt target speed is 0, the target position is the current position, and the target current can be calculated based on the load, combined with the moment balance and trigonometric function. Since the drive motor includes a damping motor and / or a dynamic balancing motor, and the damping motor can include a horizontal damping motor and a pitch damping motor, when the dynamic balancing motor in the drive motor is adjusted, the pan-tilt parameter information can be the target current.
[0078] In some embodiments, when the electric gimbal is in the second control mode, that is, in the passive mode, the main control module receives the adjustment instruction packet and parses it. Since the adjustment instruction packet includes heading adjustment data, pitch adjustment data and a verification code, the adjustment instruction packet will be parsed first. The data in the adjustment instruction packet can be parsed according to a predefined communication protocol. For example, the communication protocol can define n bytes as heading adjustment data, and another m bytes as pitch adjustment data. The main control module can obtain accurate adjustment instructions after parsing according to the communication protocol. In addition, the verification code in the adjustment instruction packet can also be verified. When the verification passes, the gimbal parameter information in the adjustment instruction packet is extracted. Among them, in the passive mode, the gimbal parameter information includes the target position and may also include the target speed.
[0079] In some embodiments, when the electric pan-tilt head is in the second control mode, a communication connection between the remote control module and the electric pan-tilt head will also be established, wherein the main control module can be connected to a remote control module by wire or wirelessly, and the remote control module has a joystick handle or an attached screen response, and the electric pan-tilt head can be controlled by receiving the swing of the joystick or performing touch screen operation on the screen. At this time, when the electric pan-tilt head is in the second control mode, its pan-tilt parameter information is obtained by the user through the operating handle, and at least one rotation angle needs to be given first, and the speed and current can also be provided auxiliary. For example, when the rotation angle is 270°, the auxiliary speed and current at this time can be understood as the auxiliary speed and current corresponding to the rotation of the electric pan-tilt head to 270°. For example, the remote control module can be connected to the main control module of the electric pan-tilt head by 2.4G wireless.
[0080] In some embodiments, when the electric pan-tilt head is in the second control mode, the pitch axis of the electric pan-tilt head may also include a spare pitch motor, which will be consistent with the pre-set working mechanism of the pitch motor when pitch-related work is required.
[0081] The pan / tilt control module 20 performs closed-loop control on the drive motor based on the pan / tilt parameter information to control the electric pan / tilt; the closed-loop control includes at least one of a position closed-loop, a speed closed-loop, and a current closed-loop.
[0082] In some embodiments, the gimbal control module 20 first determines the required gimbal control mode, and determines the closed-loop control of the drive motor according to the gimbal control mode, thereby adjusting the corresponding function of the gimbal. Among them, the drive motor includes a damping motor and / or a dynamic balancing motor, and the damping motor includes horizontal damping and pitch damping, so that the electric gimbal can also simulate the operating feel of a pure mechanical gimbal, such as damping operating feel, force operating feel or rebound operating feel, etc. The gimbal control mode includes a first control mode and / or a second control mode. Among them, the first control mode and the second control mode here correspond to the first control mode and the second control mode in the parameter acquisition module 10, respectively, and can refer to an active control mode and a passive mode, respectively.
[0083] In some embodiments, when the pan / tilt control mode is in the first control mode, the drive motor is controlled in at least one of the speed closed loop, the current closed loop and the position closed loop, and the pan / tilt function that needs to be adjusted is determined. Based on the pan / tilt function that needs to be adjusted, the corresponding closed loop control is completed to realize the driving of the drive motor, thereby adjusting the corresponding function, and further simulating the damping and dynamic balance operation feeling of the user turning the pan / tilt when the pan / tilt is a pure mechanical damping structure and a mechanical dynamic balance structure. Among them, if the pan / tilt function that needs to be adjusted is damping adjustment, the drive motor is controlled in the speed closed loop, and the drive motor is controlled to complete the speed closed loop adjustment according to the pan / tilt parameter information to adjust the corresponding pan / tilt damping function, and the pan / tilt parameter information is the target speed at this time. Alternatively, the drive motor is controlled in the three closed loop control modes of speed closed loop, position closed loop and current closed loop, and the three closed loop control modes are input according to the pan / tilt parameter information for closed loop adjustment to adjust the pan / tilt damping function, and the pan / tilt parameter information at this time is also the target speed. Among them, the target speed is 0.
[0084] In some embodiments, when controlling the drive motor in a speed closed loop, the speed closed loop specifically calculates the initial speed based on the target speed and a preset PID algorithm, and calculates the error value corresponding to the initial speed and the target speed. The preset number of rounds of iterative calculations are performed based on the error value and the PID algorithm, and the drive motor is controlled to complete the speed closed loop adjustment based on the rotation speed obtained by the iterative calculation.
[0085] In some embodiments, the initial speed is calculated based on the target speed and the PID (Proportion Integral Differential) algorithm. At this time, there will be an error value between the calculated initial speed and the target speed. In the first control mode, the target speed is 0 at the beginning, so as to simulate the state when the user initially turns the handle. In the second control mode, the target speed is the speed sent by the handle.
[0086] Please refer back to Figure 3 In some embodiments, a preset number of iterative calculations are performed according to the error value and the PID algorithm, that is, the output speed calculated according to the error value and the PID algorithm is used as the input speed in the next round of calculation, that is, the preset value in the next round of PID calculation, so as to continuously refresh and continuously generate output values as parameter information. Among them, the calculated output value can also be fed back to the next round of PID calculation through a sensor.
[0087] Please refer back to Figure 4 In some embodiments, the electric pan / tilt head is controlled by controlling the driving motor in a three-closed-loop control mode of speed closed loop, position closed loop and current closed loop. The three-closed-loop control mode is based on speed closed loop, and position closed loop and current closed loop are used as auxiliary. In the three-closed-loop control mode, the speed closed loop, position closed loop and current closed loop are constantly calculated and updated. Therefore, the parameter information and the corresponding target position and target current will be refreshed in real time to ensure the smoothness of the rotation. At the same time, the auxiliary speed closed loop and current closed loop are used to assist the user in maintaining a uniform speed or force during the rotation process, thereby improving the user's experience.
[0088] In some embodiments, when the gimbal control mode is in the first control mode, the drive motor is controlled in at least one of the speed closed loop, the current closed loop and the position closed loop, and the gimbal function that needs to be adjusted is determined, and the corresponding closed loop control is completed based on the gimbal function that needs to be adjusted to achieve the drive of the drive motor, thereby adjusting the corresponding function. Among them, if the gimbal function that needs to be adjusted is dynamic balance adjustment, the drive motor is controlled in the current closed loop, and the drive motor is controlled to complete the current closed loop adjustment according to the gimbal parameter information to adjust the corresponding dynamic balance function. At this time, the gimbal parameter information is the target current. When the gimbal function that needs to be adjusted is dynamic balance adjustment, the drive motor can also be controlled in the position closed loop, and the drive motor is controlled to complete the position closed loop adjustment based on the gimbal parameter information to adjust the dynamic balance function of the gimbal. At this time, the gimbal parameter information is the target position. When the gimbal function that needs to be adjusted is dynamic balance adjustment, the drive motor can also be controlled in sequence to perform three closed-loop controls of position closed-loop, speed closed-loop and current closed-loop. Based on the gimbal parameter information, the drive motor is controlled to complete the three closed-loop control to adjust the dynamic balance function of the gimbal. At this time, the gimbal parameter information is the target position.
[0089] In some embodiments, when the gimbal control mode is in the second control mode, the control drive motor is at least in a position closed loop, which may include controlling the drive motor in a position closed loop, and may also include controlling the drive motor in a position closed loop, a speed closed loop, and a current closed loop, and the drive motor is controlled based on the gimbal parameter information to complete the position closed loop control adjustment, so as to adjust the dynamic balance function of the gimbal, wherein the gimbal parameter information includes at least the target position. Since the second control mode is a passive control mode, it can be achieved by means of a remote control handle. Therefore, the remote control handle will also send the rotation angle, that is, the target position, or the auxiliary speed and current at the same time, indicating the expected control angle of the electric gimbal, and the speed and force to assist in achieving it.
[0090] Please refer back to Figure 5 In some embodiments, when the driving motor is controlled in the three closed loops of position closed loop, speed closed loop and current closed loop in sequence, the force of the load acting on the driving motor is received, and the corresponding rotation position is obtained according to the force. The expected speed is calculated according to the rotation position closed loop, and the expected current is further calculated. According to the current closed loop calculation, the corresponding force is output to drive the driving motor, and the driving motor will rotate to the actual rotation position, thereby achieving dynamic balance. It can be understood that in the above process as a cyclic process, the position, speed and current value feedback can be collected by the sensor and the next round of calculation can be performed to achieve the precise control of the position, speed and force of the electric pan-tilt during the rotation process, and the control stability can be achieved. Among them, the current value in the motor can be sampled by the current, and returned to the calculation before the current closed loop, and the PID calculation in the current closed loop can be re-performed in combination with the sampled current value. The motor speed at the actual rotation position will also have an encoder change value. The motor speed at this time can be returned to the speed loop calculation before the speed loop calculation, and the PID calculation in the speed closed loop can be re-performed in combination with the motor speed. Similarly, there is an encoder accumulated value between the electrode rotation position and the actual rotation position. The motor rotation position is returned to before the position closed loop calculation, and the PID calculation in the position closed loop is re-performed in combination with the motor rotation position.
[0091] In some embodiments, a display screen is also provided on the electric pan-tilt head, and the display screen can display the received content to be displayed. At the same time, the electric pan-tilt head also includes a horizontal damping adjustment knob, a pitch damping adjustment knob, and a dynamic balance adjustment knob, and the horizontal damping adjustment knob, the pitch damping adjustment knob, and the dynamic balance adjustment knob are adjusted according to the received user needs, wherein the user needs can be the received damping gear and dynamic balance gear parameters. In this way, the damping and load-bearing capacity during the rotation process are adjusted.
[0092] Those skilled in the art will appreciate that all or part of the functions of the various methods in the above-mentioned embodiments can be implemented by hardware or by computer programs. When all or part of the functions in the above-mentioned embodiments are implemented by computer programs, the program can be stored in a computer-readable storage medium, and the storage medium can include: read-only memory, random access memory, disk, optical disk, hard disk, etc., and the program is executed by a computer to implement the above-mentioned functions. For example, the program is stored in the memory of the device, and when the program in the memory is executed by the processor, all or part of the above-mentioned functions can be implemented. In addition, when all or part of the functions in the above-mentioned embodiments are implemented by computer programs, the program can also be stored in a storage medium such as a server, another computer, disk, optical disk, flash disk or mobile hard disk, and can be downloaded or copied and saved in the memory of the local device, or the system of the local device is updated, and when the program in the memory is executed by the processor, all or part of the functions in the above-mentioned embodiments can be implemented.
[0093] The above specific examples are used to illustrate the present invention, which is only used to help understand the present invention and is not intended to limit the present invention. For those skilled in the art, according to the concept of the present invention, some simple deductions, modifications or substitutions can be made.
Claims
1. A control method for an electric pan-tilt platform, applied to an electric pan-tilt platform including a driving motor, wherein: The electric pan-tilt platform is used to support a target object, and is characterized by comprising: When a pan / tilt rotation instruction is received, obtaining pan / tilt parameter information of the electric pan / tilt; Based on the pan / tilt parameter information, closed-loop control of the drive motor is completed to control the electric pan / tilt; the closed-loop control includes at least one of a position closed-loop, a speed closed-loop, and a current closed-loop.
2. The method according to claim 1, characterized in that Before receiving the pan / tilt rotation instruction, the control method includes: Determine the required PTZ control mode; Based on the gimbal control mode, a corresponding closed-loop control is determined to control the drive motor, thereby adjusting the corresponding function of the gimbal.
3. The method according to claim 2, characterized in that The driving motor includes a damping motor and / or a dynamic balancing motor, and the gimbal control mode includes a first control mode and / or a second control mode, wherein the corresponding closed-loop control is determined based on the gimbal control mode to control the driving motor, thereby adjusting the corresponding function of the gimbal, including: When the pan / tilt control mode is in the first control mode, controlling the drive motor in at least one of a speed closed loop, a current closed loop, and a position closed loop; When the pan / tilt control mode is in the second control mode, the drive motor is controlled to be at least in a position closed loop.
4. The method according to claim 3, characterized in that If the required pan-tilt control mode is the first control mode, when the pan-tilt control mode is the first control mode, controlling the drive motor in at least one of a speed closed loop, a current closed loop, and a position closed loop includes: Determine the pan / tilt function that needs to be adjusted, and determine the corresponding closed-loop control based on the pan / tilt function that needs to be adjusted to drive the drive motor, thereby adjusting the corresponding function.
5. The method according to claim 4, characterized in that If the pan / tilt function that needs to be adjusted is damping adjustment, the determining the pan / tilt function that needs to be adjusted, and controlling the driving motor based on the closed-loop control corresponding to the pan / tilt function that needs to be adjusted to adjust the corresponding function of the pan / tilt, include: Controlling the drive motor in the speed closed loop; Based on the gimbal parameter information, the driving motor is controlled to complete closed-loop speed regulation to adjust the corresponding gimbal damping function; wherein the gimbal parameter information is a target speed; or, Control the drive motor in a three-closed-loop control mode of the speed closed loop, the position closed loop and the current closed loop; The three closed-loop control modes are input according to the gimbal parameter information to perform closed-loop adjustment to adjust the gimbal damping function, wherein the gimbal parameter information is a target speed.
6. The method according to claim 4, characterized in that If the gimbal function that needs to be adjusted is dynamic balance adjustment, the determining the gimbal function that needs to be adjusted, and controlling the driving motor based on the closed-loop control corresponding to the gimbal function that needs to be adjusted to adjust the corresponding function of the gimbal, include: Controlling the driving motor in the current closed loop; Based on the gimbal parameter information, the driving motor is controlled to complete current closed-loop regulation to adjust the corresponding dynamic balancing function, wherein the gimbal parameter information is a target current; or Controlling the driving motor to close the loop at the position; Based on the gimbal parameter information, the driving motor is controlled to complete position closed-loop adjustment to adjust the dynamic balance function of the gimbal, wherein the gimbal parameter information is the target position; or Control the drive motor to sequentially perform three closed-loop control of the position closed-loop, the speed closed-loop and the current closed-loop; The driving motor is controlled based on the gimbal parameter information to complete the three-closed-loop control to adjust the dynamic balance function of the gimbal, wherein the gimbal parameter information is the target position.
7. The method according to claim 3, characterized in that If it is determined that the pan / tilt control mode is the second control mode, when the pan / tilt control mode is the second control mode, controlling the drive motor at least in a position closed loop further includes: Controlling the drive motor in position closed loop, speed closed loop and current closed loop; The driving motor is controlled based on the gimbal parameter information to complete the position closed-loop control adjustment to adjust the dynamic balance function of the gimbal, wherein the gimbal parameter information at least includes a target position.
8. The method according to claim 1, characterized in that When a pan / tilt rotation instruction is received, obtaining pan / tilt parameter information of the electric pan / tilt includes: When receiving a pan / tilt rotation instruction, determining a control mode corresponding to the electric pan / tilt; When the electric pan-tilt platform is in the first control mode, receiving pan-tilt platform parameter information when the user manually operates the electric pan-tilt platform; When the electric pan / tilt platform is in the second control mode, an adjustment instruction packet from the control end is received and parsed to extract pan / tilt parameter information in the adjustment instruction packet.
9. The method according to claim 8, characterized in that When the electric pan / tilt platform is in the second control mode, the method further comprises: Establish a communication connection between a preset remote control module and the electric pan-tilt head, and when an operation signal sent by the remote control module is received, perform closed-loop control on the drive motor based on the pan-tilt head parameter information to control the electric pan-tilt head; wherein the operation signal includes a signal generated by controlling the joystick handle in the remote control module or a signal generated by performing a touch screen operation on the remote control module.
10. A control device for an electric pan-tilt platform, applied to an electric pan-tilt platform including a driving motor, wherein: The electric pan-tilt platform is used to support a target object, and is characterized by comprising: A parameter acquisition module, used for acquiring pan / tilt parameter information of the electric pan / tilt when receiving a pan / tilt rotation instruction; The gimbal control module is used to complete the closed-loop control of the drive motor based on the gimbal parameter information to control the electric gimbal; the closed-loop control includes at least one of a position closed loop, a speed closed loop and a current closed loop.
