Platform lifting fixed-point control method and device, electronic equipment and storage medium

By adjusting the encoded motor speed and platform angle in real time, and using height and attitude data, the problem of insufficient fixed-point control accuracy of traditional encoded motors is solved, and the platform is stable and precisely lifted.

CN118992880APending Publication Date: 2024-11-22WUHAN DAOXIAOFEI TECH CO LTD
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202411160188.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-22
Publication Date
2024-11-22

AI Technical Summary

Technical Problem

The traditional coded motor coil lifting fixed-point control is affected due to factors such as friction and load changes, and the measurement accuracy cannot be stopped accurately at the specified position.

Method used

By obtaining platform height data and target height calculation height error, adjusting the encoded motor speed, and obtaining platform attitude and rope change data in real time, adjusting platform angle and height error, ensuring that the platform is lifted and lowered to the target position stably and accurately.

Benefits of technology

The platform is achieved to gradually approach the target height and maintain horizontal movement, ensuring that the platform can accurately reach the designated position.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118992880A_ABST
    Figure CN118992880A_ABST
Patent Text Reader

Abstract

The invention relates to a platform lifting fixed point control method and device, electronic equipment and a storage medium, and belongs to the technical field of automatic control, the platform lifting fixed point control method is used for controlling a platform to horizontally lift to a target position, and the method comprises the following steps: calculating a height error based on acquired height data of the platform and a target height, determining a speed of the coded motor based on the height error; the attitude data of the platform and the rope winding change data of the coding motor in the lifting motion process are obtained in real time, the angle of the platform is adjusted based on the attitude data, and the height error is adjusted in real time based on the rope winding change data; and controlling the platform to lift based on the speed of the coding motor, the height error and the angle of the platform until the platform is horizontally lifted to a target position.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of automatic control technology, and in particular to a platform lifting fixed-point control method, device, electronic equipment and storage medium. Background Art

[0002] The traditional encoder motor rope lifting and lowering fixed point is usually controlled by an encoder. The encoder is a device used to measure the rotation position and speed of the motor. It can convert the motor's motion information into a digital signal, thereby achieving precise control of the motor. In the rope lifting system, the encoder is usually installed on the motor shaft. By detecting the angle and speed of the motor's rotation, the motor is controlled to stop at a specified position.

[0003] However, there are some problems with the traditional encoder motor rope lifting and lowering fixed point. Due to the influence of factors such as friction and load changes, the measurement accuracy of the encoder will be affected to a certain extent, resulting in the encoder motor being unable to stop accurately at the specified position. Summary of the invention

[0004] In view of this, it is necessary to provide a platform lifting fixed-point control method, device, electronic equipment and storage medium to solve the technical problem that the encoder motor cannot stop accurately at the specified position.

[0005] In order to solve the above problems, the present invention provides a platform lifting fixed-point control method for controlling the platform to be lifted horizontally to a target position, comprising: Calculating a height error based on the acquired height data of the platform and the target height, and determining a speed of the encoder motor based on the height error; Acquire the posture data of the platform and the rope change data of the encoder motor in real time during the lifting movement, adjust the angle of the platform based on the posture data, and adjust the height error in real time based on the rope change data; The platform is controlled to be lifted or lowered based on the speed of the encoder motor, the height error, and the angle of the platform until the platform is lifted or lowered horizontally to a target position.

[0006] In a possible implementation, the posture data of the platform is acquired in real time by a gyroscope sensor, and the height data of the platform is acquired in real time by a laser sensor.

[0007] In a possible implementation, the encoding motor includes a first encoding motor, a second encoding motor, and a third encoding motor; and determining the speed of the encoding motor based on the height error includes: A voltage signal of the first encoder motor is determined based on the height error, and a speed of the first encoder motor is determined based on the voltage signal, wherein speeds of the second encoder motor and the third encoder motor are consistent with the speed of the first encoder motor.

[0008] In a possible implementation, adjusting the angle of the platform based on the posture data includes: Determine whether the state of the platform is a horizontal state based on the posture data, and when the state of the platform is not a horizontal state, determine an angle error based on the posture data, and determine a voltage signal of the second encoder motor and a voltage signal of the third encoder motor based on the angle error; determining an angle of the second encoder motor based on a voltage signal of the second encoder motor, and adjusting a pitch angle of the platform based on the angle of the second encoder motor; The angle of the third encoder motor is determined based on the voltage signal of the third encoder motor, and the roll angle of the platform is adjusted based on the angle of the third encoder motor.

[0009] In a possible implementation, the real-time adjustment of the height error based on the rope winding change data includes: Acquire the height data at the current moment and the rope winding radius of the encoder motor, and determine the height error based on the height data at the current moment and the target height; Determine the number of rotations of the encoding motor based on the height error and the rope winding radius, and determine a first rope winding radius of the encoding motor based on the number of rotations of the encoding motor; First height data corresponding to the first rope winding radius is obtained, a deviation value is determined based on the first height data and a target height, and the height error is updated based on the deviation value.

[0010] In a possible implementation, the calculation formula for the number of rotations of the encoder motor is: , in, is the number of revolutions of the encoder motor, is the height error, is the rope radius at the current moment.

[0011] In a possible implementation, controlling the platform to be lifted and lowered based on the speed of the encoder motor, the height error, and the angle of the platform until the platform is lifted and lowered horizontally to a target position includes: Step 1: Control the platform to move up and down horizontally based on the speed of the encoder motor and the angle of the platform, and determine the number of rotations of the encoder motor based on the height error; Step 2: When the encoder motor moves to a corresponding number of rotations, the encoder motor stops moving. When the encoder motor stops moving, the height data of the platform is acquired, a deviation value is calculated based on the height data and a target height, a first number of rotations of the encoder motor is determined based on the deviation value, a pulse signal of the encoder motor is determined based on the first number of rotations, the encoder motor is controlled to move to the first number of rotations based on the pulse signal, and the height error and the speed of the encoder motor are updated; Step 3: Repeat steps 1 and 2 until the platform is lifted and lowered to the target position.

[0012] On the other hand, the present invention also provides a platform lifting fixed-point control device, which is used to control the platform to be lifted horizontally to a target position, comprising: A lifting speed determination module, used to determine a height error based on the acquired platform height data and a target height, and determine a speed of the encoder motor based on the height error; The encoder motor adjustment module is used to obtain the posture data of the platform and the rope change data of the encoder motor in real time during the lifting movement, adjust the angle of the platform based on the posture data, and adjust the height error in real time based on the rope change data; The lifting control module is used to control the lifting of the platform based on the speed of the encoder motor, the height error and the angle of the platform until the platform is lifted horizontally to a target position.

[0013] In another aspect, the present invention further provides an electronic device, comprising: a processor and a memory; The memory stores a computer-readable program executable by the processor; When the processor executes the computer-readable program, the steps in the platform lifting and fixed-point control method as described above are implemented.

[0014] On the other hand, the present invention also provides a computer-readable storage medium, which stores one or more programs, and the one or more programs can be executed by one or more processors to implement the steps in the platform lifting and fixed-point control method as described above.

[0015] The beneficial effects of the present invention are: real-time adjustment of the height error based on the rope winding change data, control of the platform to rise and fall based on the speed of the encoding motor, the height error and the angle of the platform, until the platform is horizontally raised and lowered to the target position, adjustment of the speed of the encoding motor according to the position change of the platform, and control of the horizontal lifting of the platform by the encoding motor, ensure that the platform stably and accurately gradually approaches the target height and maintains horizontal movement. BRIEF DESCRIPTION OF THE DRAWINGS

[0016] Figure 1A flow chart of an embodiment of a platform lifting and fixed-point control method provided by the present invention; Figure 2 A flowchart of an embodiment of step S102 of the platform lifting and fixed-point control method provided by the present invention; Figure 3 A flow chart of another embodiment of step S102 of the platform lifting and fixed-point control method provided by the present invention; Figure 4 A flowchart of an embodiment of step S103 of the platform lifting and fixed-point control method provided by the present invention; Figure 5 A schematic structural diagram of an embodiment of a platform lifting and fixed-point control device provided by the present invention; Figure 6 A schematic structural diagram of an embodiment of an electronic device provided by the present invention. DETAILED DESCRIPTION

[0017] The preferred embodiments of the present invention will be described in detail below in conjunction with the accompanying drawings, wherein the accompanying drawings constitute a part of this application and are used together with the embodiments of the present invention to illustrate the principles of the present invention, but are not used to limit the scope of the present invention.

[0018] The present invention discloses a platform lifting fixed-point control method, device, electronic device and storage medium, which can be used in a computer. The method, device or computer-readable storage medium involved in the present invention can be integrated with the above-mentioned device or can be relatively independent.

[0019] A specific embodiment of the present invention discloses a platform lifting and fixed-point control method, which can be executed by a computer, and specifically can be executed by one or more processors of the computer. Figure 1 is a flow chart of the platform lifting fixed-point control method provided by an embodiment of the present invention, please refer to Figure 1 , a platform lifting fixed-point control method is used to control the platform to lift horizontally to a target position, including: S101, calculating a height error based on the acquired platform height data and the target height, and determining a speed of the encoder motor based on the height error; S102, acquiring the posture data of the platform and the rope change data of the encoder motor in real time during the lifting movement, adjusting the angle of the platform based on the posture data, and adjusting the height error in real time based on the rope change data; S103, controlling the platform to rise and fall based on the speed of the encoder motor, the height error, and the angle of the platform until the platform is horizontally raised and lowered to a target position.

[0020] Among them, the encoding motor includes a first encoding motor, a second encoding motor and a third encoding motor. The speed of the first encoding motor is adjusted in real time according to the change of the height error. The posture data of the platform is obtained in real time through the gyroscope sensor, and the height data of the platform is obtained in real time through the laser sensor.

[0021] Compared with the prior art, the platform lifting fixed-point control method provided in this embodiment calculates the height error based on the acquired platform height data and the target height, determines the speed of the encoder motor based on the height error, adjusts the speed of the encoder motor in real time according to the height error, obtains the platform posture data and the rope winding change data of the encoder motor during the lifting movement in real time, adjusts the platform angle based on the posture data, adjusts the height error in real time based on the rope winding change data, controls the platform to lift and lower based on the speed of the encoder motor, the height error and the angle of the platform, until the platform is lifted and lowered to the target position horizontally, ensuring that the platform stably and accurately approaches the target height step by step and maintains horizontal movement.

[0022] In some embodiments, in step S101, the height data of the platform is acquired in real time by a laser sensor to obtain the target height of the target point, the height error is calculated based on the height data of the platform and the target height, and the speed of the encoding motor is determined based on the height error. The encoding motor includes a first encoding motor, a second encoding motor and a third encoding motor. The process of determining the speed of the encoding motor is: determining the voltage signal of the first encoding motor based on the height error, and determining the speed of the first encoding motor based on the voltage signal of the first encoding motor, that is, according to the height error, the voltage signal of the first encoding motor is calculated by a PID algorithm, and the voltage signal of the first encoding motor is a fixed signal. The rotation speed of the first encoding motor is determined by the fixed voltage signal, and the speeds of the second encoding motor and the third encoding motor are consistent with the speed of the first encoding motor, that is, the vertical movement of the platform is controlled by the stable speed of the encoding motor to ensure the stable lifting and lowering of the platform.

[0023] In some embodiments, in step S102, during the lifting and lowering movement of the platform, the attitude data of the platform is acquired in real time through a gyroscope sensor, and the attitude data includes the pitch angle and roll angle of the platform.

[0024] In some embodiments, see Figure 2 , adjust the angle of the platform based on the platform's posture data, including: S201, determining whether the state of the platform is a horizontal state based on the posture data, and when the state of the platform is not a horizontal state, determining an angle error based on the posture data, and determining a voltage signal of the second encoding motor and a voltage signal of the third encoding motor based on the angle error; S202, determining the angle of the second encoder motor based on the voltage signal of the second encoder motor, and adjusting the pitch angle of the platform based on the angle of the second encoder motor; S203: Determine the angle of the third encoder motor based on the voltage signal of the third encoder motor, and adjust the rolling angle of the platform based on the angle of the third encoder motor.

[0025] In some embodiments, in step S201, whether the state of the platform is horizontal is determined based on the posture data of the platform. When the state of the platform is not horizontal, the angle error is determined based on the posture data, and the voltage signal of the second encoding motor and the voltage signal of the third encoding motor are determined based on the angle error.

[0026] In some embodiments, in step S202, the angle of the second encoder motor is determined based on the voltage signal of the second encoder motor, and the pitch angle of the platform is adjusted based on the angle of the second encoder motor.

[0027] In some embodiments, in step S203, the angle of the third encoder motor is determined based on the voltage signal of the third encoder motor, the roll angle of the platform is adjusted based on the angle of the third encoder motor, and the pitch angle and roll angle of the platform are adjusted by the second encoder motor and the third encoder motor to keep the platform in a horizontal state in real time during the lifting process.

[0028] In some embodiments, see Figure 3 , adjust the height error in real time based on the rope change data, including: S301, obtaining the current height data and the rope winding radius of the encoder motor, and determining the height error based on the current height data and the target height; S302, determining the number of rotations of the encoding motor based on the height error and the rope winding radius, and determining a first rope winding radius of the encoding motor based on the number of rotations of the encoding motor; S303, obtaining first height data corresponding to the first rope winding radius, determining a deviation value based on the first height data and the target height, and updating the height error based on the deviation value.

[0029] Among them, during the platform lifting process, the encoding motor controls the platform lifting by adjusting the length of the winding rope, determines the lifting distance of the platform by the change of the winding rope, obtains the winding rope change data of the encoding motor in real time, and adjusts the height error in real time based on the winding rope change data.

[0030] In some embodiments, in step S301, the height data of the platform at the current moment and the rope winding radius of the encoder motor are obtained, and the height error is calculated based on the height data of the platform and the target height.

[0031] In some embodiments, in step S302, the number of rotations of the encoding motor is determined based on the height error and the rope winding radius, that is, the number of rotations that the encoding motor needs to rotate at the next moment is determined, and the first rope winding radius of the encoding motor is determined based on the number of rotations of the encoding motor, that is, when the encoding motor moves to the corresponding number of rotations, the rope winding radius of the encoding motor at this time is determined.

[0032] In some embodiments, in step S303, the first height data corresponding to the first rope winding radius is obtained, that is, the height data of the platform at this time is obtained by the laser sensor, and the deviation value is calculated based on the first height data and the target height, and the height error is updated by the deviation value. The calculation formula of the number of rotations of the encoder motor is: , in, is the number of revolutions of the encoder motor, is the height error, is the rope coiling radius at the current moment; The calculation formula for the rope radius is: , in, is the rope radius at the current moment, is the rope radius at the initial moment, is the current length of the coiled rope, is the length of the coiled rope at the initial moment; The calculation formula for the length of the coiled rope is: , The changes in the rope winding can determine the lifting and lowering changes of the platform.

[0033] In some embodiments, see Figure 4 In step S103, the platform is controlled to be lifted or lowered based on the speed of the encoder motor, the height error, and the angle of the platform until the platform is lifted or lowered horizontally to the target position, including: S401, step 1, controlling the platform to move up and down horizontally based on the speed of the encoder motor and the angle of the platform, and determining the number of rotations of the encoder motor based on the height error; S402, step 2, when the encoder motor moves to the corresponding number of rotations, the encoder motor stops moving, when the encoder motor stops moving, the height data of the platform is obtained, the deviation value is calculated based on the height data and the target height, the first number of rotations of the encoder motor is determined based on the deviation value, the pulse signal of the encoder motor is determined based on the first number of rotations, the encoder motor is controlled to move to the first number of rotations based on the pulse signal, and the height error and the speed of the encoder motor are updated; S403, step 3, repeat steps 1 to 2 until the platform is lifted and lowered horizontally to the target position.

[0034] In some embodiments, in step S401, the platform is controlled to be raised or lowered horizontally based on the speed of the encoder motor and the angle of the platform, that is, the lifting speed of the platform is adjusted based on the speed of the encoder motor. When the platform is not in a horizontal state, the angle of the platform is adjusted in real time, and the number of rotations of the encoder motor is determined based on the height error.

[0035] In some embodiments, in step S402, when the encoder motor moves to a corresponding number of rotations, the encoder motor stops moving. When the encoder motor stops moving, the height data of the platform is obtained through a laser sensor, and a deviation value is calculated based on the height data and the target height. The first number of rotations of the encoder motor is determined based on the deviation value, that is, the distance that the platform needs to be lifted or lowered at the next moment is determined through the first number of rotations of the encoder motor. The pulse signal of the encoder motor is determined based on the first number of rotations, and the encoder motor sends 100 pulse signals to the controller when it rotates one circle. After the pulse signal of the encoder motor is fed back to the controller, the movement and stop of the encoder motor is controlled by the controller. According to the pulse signal of the encoder motor, the controller controls the encoder motor to move to the corresponding number of rotations, and updates the height error at the next moment and the speed of the encoder motor.

[0036] In some embodiments, in step S403, the above steps 1 to 2 are repeated until the platform is lifted or lowered horizontally to the target position, that is, the platform is controlled by the encoding motor to be infinitely close to the target position.

[0037] At the initial moment, the three encoder motors are initialized to ensure that the initial position is correct, the bottom platform is calibrated to be level, the gyroscope feedback is started, and the sampling frequency of the laser rangefinder is set to 20Hz. At the beginning, the laser sensor detects that the distance difference between the platform and the target position is 1m, that is, the height error is 1m. The speed of the encoder motor is adjusted according to the height error, and the number of rotations of the encoder motor is calculated. Then, the encoder motor is controlled to move downward for 1m according to the speed of the encoder motor. When the state of the platform is not horizontal, the angle of the platform is adjusted by the encoder motor. After the movement is completed, the height of the platform is detected by the laser sensor. Due to the change in the winding radius of the encoder motor, the encoder motor cannot control the platform to rise or fall to the position of 1m. Therefore, the deviation value between the platform and the target position is calculated. When the deviation value between the platform and the target position is detected to be 0.1m, the encoder motor is controlled to move for 0.1m. The number of rotations, after the movement is completed, the deviation value between the platform and the target position is detected again, and the above actions are repeated to keep the platform in a horizontal state and gradually approach the target position.

[0038] At the initial moment, the data of the current laser sensor is 0.2 meters, and the target is 1 meter. The calculated lifting difference is 0.8 meters, that is, the target height error is 0.8 meters. At this time, the rope radius is 20 cm, and the number of circles the motor needs to rotate is n=80 / (3.14*40)=0.637 circles. The encoder will send 100 pulses to the microcontroller for each circle of the motor. 0.637 circles correspond to 63.7 pulses. The microcontroller stops the motor after receiving 63.7 pulses. When the motor stops, the rope radius changes to 12 cm, and the laser value read is 0.95 meters, that is, the deviation value is 0.05 meters at this time. The number of encoded pulses corresponding to the number of circles of the deviation value of 0.05 meters is sent to the microcontroller, and the microcontroller controls the motor to move until the laser data is infinitely close to 1 meter, and then stops the control.

[0039] Combining the attitude data of the gyroscope and the height data of the laser rangefinder, the operating status of the motor is adjusted in real time, that is, by adjusting the speed of the first encoder motor, the angle of the second encoder motor and the third encoder motor, the platform is ensured to remain stable and gradually approach the target height, the motor speed is adjusted according to the height error, and the platform is controlled to move to the specified height according to the encoder feedback, while ensuring that the platform maintains horizontal motion.

[0040] In order to better implement the platform lifting fixed-point control method in the embodiment of the present invention, based on the platform lifting fixed-point control method, correspondingly, Figure 5 As shown, the embodiment of the present invention further provides a platform lifting fixed-point control device, which is used to control the platform to be lifted horizontally to a target position. The platform lifting fixed-point control device 500 includes: A lifting speed determination module 501 is used to determine a height error based on the acquired platform height data and the target height, and determine a speed of the encoder motor based on the height error; The encoder motor adjustment module 502 is used to obtain the posture data of the platform and the rope change data of the encoder motor in real time during the lifting movement, adjust the angle of the platform based on the posture data, and adjust the height error in real time based on the rope change data; The lifting control module 503 is used to control the lifting of the platform based on the speed of the encoder motor, the height error and the angle of the platform until the platform is lifted horizontally to the target position.

[0041] like Figure 6 As shown, based on the platform lifting and fixed-point control method, the present invention also provides an electronic device 600, which can be a computing device such as a mobile terminal, a desktop computer, a notebook, a palm computer, and a server. The electronic device 600 includes a processor 601, a memory 602, and a display 603. Figure 6 Only some components of the electronic device 600 are shown, but it should be understood that it is not required to implement all of the components shown, and more or fewer components may be implemented instead.

[0042] In some embodiments, the memory 602 may be an internal storage unit of the electronic device 600, such as a hard disk or memory of the electronic device 600. In other embodiments, the memory 602 may also be an external storage device of the electronic device 600, such as a plug-in hard disk, a smart media card (SMC), a secure digital (SD) card, a flash card, etc. equipped on the electronic device 600. Further, the memory 602 may also include both an internal storage unit of the electronic device 600 and an external storage device. The memory 602 is used to store application software and various data installed in the electronic device 600, such as program codes installed in the electronic device 600. The memory 602 may also be used to temporarily store data that has been output or is to be output. In one embodiment, a platform lifting fixed-point control program is stored on the memory 602, and the platform lifting fixed-point control program can be executed by the processor 601, thereby realizing the platform lifting fixed-point control method of each embodiment of the present invention.

[0043] In some embodiments, the processor 601 may be a central processing unit (CPU), a microprocessor or other data processing chip, which is used to run program codes or process data stored in the memory 602, such as a platform lifting and fixed-point control method.

[0044] In some embodiments, the display 603 may be an LED display, a liquid crystal display, a touch-sensitive liquid crystal display, an OLED (Organic Light-Emitting Diode) touch device, etc. The display 603 is used to display the identification information of the platform lifting and fixed-point control program and to display a visual user interface. The components 601-603 of the electronic device 600 communicate with each other through a system bus.

[0045] In some embodiments, when the processor 601 executes the platform lifting and fixed-point control program in the memory 602, the various steps in the platform lifting and fixed-point control method described in the above embodiments are implemented. Since the platform lifting and fixed-point control method has been described in detail above, it will not be repeated here.

[0046] Correspondingly, an embodiment of the present application also provides a computer-readable storage medium, which is used to store computer-readable programs or instructions. When the program or instructions are executed by the processor, the steps or functions in the platform lifting and fixed-point control method provided in the above-mentioned method embodiments can be implemented.

[0047] In summary, the platform lifting fixed-point control method, device, electronic device and storage medium provided by the present invention are used to control the platform to be lifted horizontally to the target position, calculate the height error based on the acquired platform height data and the target height, and determine the speed of the encoder motor based on the height error; obtain the platform posture data and the rope winding change data of the encoder motor in real time during the lifting movement, adjust the platform angle based on the posture data, and adjust the height error in real time based on the rope winding change data; control the platform to be lifted and lowered based on the speed of the encoder motor, the height error and the angle of the platform until the platform is lifted horizontally to the target position, ensuring that the platform stably and accurately approaches the target height step by step and maintains horizontal movement.

[0048] Those skilled in the art will appreciate that all or part of the processes of the above-mentioned embodiments can be implemented by instructing related hardware through a computer program, and the program can be stored in a computer-readable storage medium, wherein the computer-readable storage medium is a disk, an optical disk, a read-only storage memory, or a random access memory, etc.

[0049] The above description is only a preferred specific implementation manner of the present invention, but the protection scope of the present invention is not limited thereto. Any changes or substitutions that can be easily conceived by any technician familiar with the technical field within the technical scope disclosed by the present invention should be covered within the protection scope of the present invention.

Claims

1. A platform lifting fixed-point control method, characterized in that: Used to control the platform to rise and fall to the target position, including: Calculating a height error based on the acquired height data of the platform and the target height, and determining a speed of the encoder motor based on the height error; Acquire the posture data of the platform and the rope change data of the encoder motor in real time during the lifting movement, adjust the angle of the platform based on the posture data, and adjust the height error in real time based on the rope change data; The platform is controlled to be lifted or lowered based on the speed of the encoder motor, the height error, and the angle of the platform until the platform is lifted or lowered horizontally to a target position.

2. The platform lifting fixed-point control method according to claim 1, characterized in that: The platform's attitude data is acquired in real time through the gyroscope sensor, and the platform's height data is acquired in real time through the laser sensor.

3. The platform lifting fixed-point control method according to claim 1, characterized in that: The encoding motor includes a first encoding motor, a second encoding motor and a third encoding motor; the determining the speed of the encoding motor based on the height error includes: A voltage signal of the first encoder motor is determined based on the height error, and a speed of the first encoder motor is determined based on the voltage signal, wherein speeds of the second encoder motor and the third encoder motor are consistent with the speed of the first encoder motor.

4. The platform lifting fixed-point control method according to claim 3 is characterized in that: The adjusting the angle of the platform based on the posture data comprises: Determine whether the state of the platform is a horizontal state based on the posture data, and when the state of the platform is not a horizontal state, determine an angle error based on the posture data, and determine a voltage signal of the second encoder motor and a voltage signal of the third encoder motor based on the angle error; determining an angle of the second encoder motor based on a voltage signal of the second encoder motor, and adjusting a pitch angle of the platform based on the angle of the second encoder motor; The angle of the third encoder motor is determined based on the voltage signal of the third encoder motor, and the roll angle of the platform is adjusted based on the angle of the third encoder motor.

5. The platform lifting fixed-point control method according to claim 3, characterized in that: The real-time adjustment of the height error based on the rope winding change data includes: Acquire the height data at the current moment and the rope winding radius of the encoder motor, and determine the height error based on the height data at the current moment and the target height; Determine the number of rotations of the encoding motor based on the height error and the rope winding radius, and determine a first rope winding radius of the encoding motor based on the number of rotations of the encoding motor; First height data corresponding to the first rope winding radius is obtained, a deviation value is determined based on the first height data and a target height, and the height error is updated based on the deviation value.

6. The platform lifting fixed-point control method according to claim 5, characterized in that: The calculation formula for the number of rotations of the encoder motor is: , in, is the number of revolutions of the encoder motor, is the height error, is the rope radius at the current moment.

7. The platform lifting fixed-point control method according to claim 5, characterized in that: The step of controlling the platform to lift based on the speed of the encoder motor, the height error, and the angle of the platform until the platform is lifted horizontally to a target position includes: Step 1: Control the platform to move up and down horizontally based on the speed of the encoder motor and the angle of the platform, and determine the number of rotations of the encoder motor based on the height error; Step 2: When the encoder motor moves to a corresponding number of rotations, the encoder motor stops moving. When the encoder motor stops moving, the height data of the platform is acquired, a deviation value is calculated based on the height data and a target height, a first number of rotations of the encoder motor is determined based on the deviation value, a pulse signal of the encoder motor is determined based on the first number of rotations, the encoder motor is controlled to move to the first number of rotations based on the pulse signal, and the height error and the speed of the encoder motor are updated; Step 3: Repeat steps 1 and 2 until the platform is lifted and lowered to the target position.

8. A platform lifting fixed-point control device, characterized in that: Used to control the platform to rise and fall to the target position, including: A lifting speed determination module, used to determine a height error based on the acquired platform height data and a target height, and determine a speed of the encoder motor based on the height error; The encoder motor adjustment module is used to obtain the posture data of the platform and the rope change data of the encoder motor in real time during the lifting movement, adjust the angle of the platform based on the posture data, and adjust the height error in real time based on the rope change data; The lifting control module is used to control the lifting of the platform based on the speed of the encoder motor, the height error and the angle of the platform until the platform is lifted horizontally to a target position.

9. An electronic device, characterized in that: including memory and processor; The memory stores a computer-readable program executable by the processor; When the processor executes the computer-readable program, the steps in the platform lifting and fixed-point control method as described in any one of claims 1 to 7 are implemented.

10. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores one or more programs, and the one or more programs can be executed by one or more processors to implement the steps in the platform lifting and fixed-point control method as described in any one of claims 1-7.

Citation Information

Cited By

  • Automatic grabbing control method for hot melting gasket of automatic laying trolley

    CN119910667A

  • An automatic grasping control method for hot melt washers of an automatic laying trolley

    CN119910667B