Crawler belt object conveying vehicle based on improved pid algorithm
Through improved PID algorithm and microcontroller control, the problem of insufficient control accuracy and stability of crawler object transport vehicles is solved, the accuracy and stability of object grabbing is improved, and more efficient item delivery is achieved.
Patent Information
- Application Number
- CN202411277177.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-12
- Publication Date
- 2024-11-08
AI Technical Summary
When existing tracked object transport vehicles install fixed robot arms on the roof platform, the control accuracy and stability are poor, making it difficult to accurately and stably grasp and convey objects.
The improved PID algorithm is used to control the drive motor through the timer C of the microcontroller, and the speed measurement and PID control of the drive motor are used to measure and control the speed of the drive motor. The timer D and E are used to control the mechanical arm mechanism. , improves the operating accuracy and stability of the tracked object conveyor truck.
It realizes higher accuracy and stability of the tracked object conveyor, improves the grabbing effect, and allows the items to be transferred to the pickup or storage objects more accurately.
Smart Images

Figure CN118907767A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of object conveying vehicles, and in particular, to a tracked object conveying vehicle based on an improved PID algorithm. Background Art
[0002] Tracked object transport vehicle refers to a "transport vehicle" that uses a track system instead of a wheel system. This type of vehicle has a small unit pressure on the ground, small sinking, strong adhesion, and strong driving ability.
[0003] The tracked object transporter in the related technology will install a fixed robotic arm on the roof platform, first use the vehicle body to transport the object to the appropriate location, and then use the robotic arm to clamp the object. This type of tracked object transporter often has poor control accuracy and poor stability, making it difficult to achieve accurate and stable grasping and transporting of objects. Summary of the invention
[0004] In order to make up for the above shortcomings, the present application provides a tracked object conveyor based on an improved PID algorithm, which, through PID control, makes the operation accuracy and stability of the tracked object conveyor better and the grasping effect better.
[0005] The present application scheme provides a crawler object conveyor based on an improved pid algorithm, including a driving mechanism, a mechanical arm mechanism and a main control mechanism;
[0006] The driving mechanism comprises a driving motor;
[0007] The main control mechanism includes a shell and a single-chip microcomputer arranged inside the shell. The single-chip microcomputer is provided with a timer A and a timer B in encoding mode for measuring the speed and PID control of the drive motor. The single-chip microcomputer is provided with a timer C for controlling the opening and closing of the drive motor. The single-chip microcomputer is also provided with a timer D and a timer E for controlling the robotic arm mechanism.
[0008] Preferably, the driving mechanism includes a fixed plate connected to the bottom end surface of the outer shell, mounting blocks are fixed on four sides of the bottom end surface of the fixed plate, each of the mounting blocks is rotatably connected to a rotating shaft, and the two mounting blocks located on different sides of the fixed plate are fixedly mounted with the driving motor whose output shaft is connected to the corresponding rotating shaft, each of the outer ends of the rotating shaft is connected to a track wheel, and tracks are tensioned on the two track wheels on the same side.
[0009] Preferably, the timer C is used to output a 10 kHz PWM wave and configure a corresponding GPIO port to control the drive motor through a tb6612 motor drive chip.
[0010] Preferably, the robotic arm mechanism includes a rotating base component installed on the top of the outer shell and a joint component driven by the rotating base component and capable of adjusting its position up, down, front and back. The outer end of the joint component is provided with a clamping claw portion to control the rotating component, and the outer end of the clamping claw portion to control the rotating component is provided with a clamping claw portion.
[0011] Preferably, the rotating base member includes a steering gear A installed on the top of the inner shell, the output end of the steering gear A can pass through the top wall of the outer shell, and is equipped with a turntable in contact with the outer top of the outer shell.
[0012] Preferably, the joint part includes a fixed bracket connected to the turntable, the fixed bracket is fixedly connected to a servo B, an inverted U-shaped frame A is fixed to the output end of the servo B, the outer end of the inverted U-shaped frame A is connected to a servo C, the output end of the servo C is connected to the inverted U-shaped frame B, the outer end of the inverted U-shaped frame B is connected to a servo D, and the output end of the servo D is connected to the inverted U-shaped frame C.
[0013] Preferably, the clamping claw portion controls the rotating member to be a steering gear E fixed to the outer end surface of the inverted U-shaped frame C.
[0014] Preferably, the clamping claw portion includes a mounting plate connected to the output end of the servo E, and two mutually meshing half-gear plates are rotatably connected to the mounting plate, and a servo F for driving and controlling one of the half-gear plates is fixed on the mounting plate, and the outer ends of the two half-gear plates are hinged with clamping arms, and a connecting rod is hinged between the middle part of the clamping arm and the outer end of the mounting plate.
[0015] Preferably, the timer D and timer E are used to output a 50 Hz PWM wave to control the servo A, the servo B, the servo C, the servo D, the servo E, and the servo F in the robotic arm mechanism.
[0016] Preferably, rubber protective plates are fixedly connected to both the front and rear sides of the bottom of the shell.
[0017] Beneficial effect: The present application provides a tracked object conveyor based on an improved PID algorithm, which controls the drive motor through the timer C of the single-chip microcomputer so that the tracked object conveyor is transferred to the object retrieval location or the object storage location. During this process, the timer A and timer B of the single-chip microcomputer are set to encoder mode for driving motor speed measurement and PID control, and the mechanical control of the robot arm mechanism is realized through the timer D and timer E of the single-chip microcomputer for object grabbing. BRIEF DESCRIPTION OF THE DRAWINGS
[0018] In order to more clearly illustrate the technical solutions of the implementation methods of the present application, the drawings required for use in the implementation methods will be briefly introduced below. It should be understood that the following drawings only show certain embodiments of the present application and therefore should not be regarded as limiting the scope. For ordinary technicians in this field, other related drawings can be obtained based on these drawings without paying creative work.
[0019] Figure 1 This is a structural schematic diagram of a crawler object conveying vehicle based on an improved pid algorithm provided in an embodiment of the present application, viewpoint 1;
[0020] Figure 2 A second perspective diagram of the structure of a crawler object transport vehicle based on an improved pid algorithm provided in an embodiment of the present application;
[0021] Figure 3 A schematic diagram of the structure of a robotic arm mechanism provided in an embodiment of the present application;
[0022] Figure 4 A schematic diagram of the structure of the clamping jaw portion provided in an embodiment of the present application;
[0023] Figure 5 A schematic diagram of the structure of a main control mechanism provided in an embodiment of the present application after partial cutaway;
[0024] Figure 6 A schematic diagram of the drive mechanism structure provided in an embodiment of the present application.
[0025] In the figure: 1-main control mechanism; 11-housing; 12-single chip microcomputer; 13-timer A; 14-timer B; 15-timer C; 16-timer D; 17-timer E; 18-rubber protective plate; 2-driving mechanism; 21-fixing plate; 22-mounting block; 23-rotating shaft; 24-driving motor; 25-track wheel; 26-track; 3-mechanical arm mechanism; 31-rotating base member; 311 -Servo A; 312-turntable; 32-joint; 321-fixed bracket; 322-servo B; 323-inverted U-shaped frame A; 324-servo C; 325-inverted U-shaped frame B; 326-servo D; 327-inverted U-shaped frame C; 33-clamping part controlling the rotating part; 34-clamping part; 341-mounting plate; 342-semi-gear plate; 343-servo F; 344-clamping arm; 345-connecting rod. DETAILED DESCRIPTION
[0026] The technical solutions in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, rather than all of the embodiments.
[0027] See also Figure 1-Figure 6, the present application provides a crawler object transport vehicle based on an improved pid algorithm, comprising a driving mechanism 2, a mechanical arm mechanism 3 and a main control mechanism 1;
[0028] The driving mechanism 2 includes a driving motor 24;
[0029] The main control mechanism 1 includes a shell 11 and a single-chip microcomputer 12 arranged inside the shell. The single-chip microcomputer 12 is provided with a timer A13 and a timer B14 in encoding mode for speed measurement and PID control of the drive motor 24. The single-chip microcomputer 12 is provided with a timer C15 for controlling the opening and closing of the drive motor 24. The single-chip microcomputer 12 is also provided with a timer D16 and a timer E17 for controlling the robot arm mechanism 3.
[0030] In this embodiment, the drive motor 24 is controlled by the timer C15 of the single-chip computer 12, so that the tracked object conveyor is transferred to the object picking place or the object storage place. In this process, the timer A13 and timer B14 of the single-chip computer 12 are set to the encoder mode for speed measurement and PID control of the drive motor 24. The mechanical control of the robot arm mechanism 3 is realized by the timer D16 and timer E17 of the single-chip computer 12 for object grabbing.
[0031] The driving mechanism 2 includes a fixed plate 21 connected to the bottom end face of the housing 11, and mounting blocks 22 are fixed on the four sides of the bottom end face of the fixed plate 21. A rotating shaft 23 is rotatably connected to each mounting block 22, and a driving motor 24 whose output shaft is connected to the corresponding rotating shaft 23 is fixedly mounted on two mounting blocks 22 located on different sides of the fixed plate 21. A track wheel 25 is connected to the outer end of each rotating shaft 23, and a track 26 is tensioned on the two track wheels 25 on the same side. Specifically, the timer C15 of the single-chip computer 12 controls the driving motor 24. After the driving motor 24 is started, the corresponding rotating shaft 23 rotates, and the track 26 is indirectly used to drive the housing 11 at the top of the fixed plate 21 to move, so that the tracked object conveyor is transferred to the object retrieval location or the object storage location.
[0032] Timer C15 is used to output a 10khz PWM wave and configure the corresponding GPIO port to control the drive motor 24 through the tb6612 motor driver chip.
[0033] The mechanical arm mechanism 3 includes a rotating base member 31 installed on the top of the housing 11 and a joint member 32 driven by the rotating base member 31 and capable of adjusting the position up and down, front and back. The outer end of the joint member 32 is provided with a clamping claw portion to control the rotating member 33, and the outer end of the clamping claw portion to control the rotating member 33 is provided with a clamping claw portion 34. Specifically, the rotating base member 31 can be used to rotate the joint member 32, the clamping claw portion to control the rotating member 33, and the clamping claw portion 34 on the upper part thereof and reach a suitable position; the joint member 32 can be used to adjust the clamping claw portion to control the rotating member 33 and the clamping claw portion 34 up and down, front and back to a suitable position; and the clamping claw portion 33 can be used to rotate the clamping claw portion 34 to an angle so that objects are neatly stored in a suitable position, and the clamping claw portion 34 can be used to grab or release objects.
[0034] The rotating base member 31 includes a steering gear A311 installed at the top of the housing 11. The output end of the steering gear A311 can pass through the top wall of the housing 11, and is provided with a turntable 312 in contact with the top of the housing 11. Specifically, after the steering gear A311 is started, the turntable 312 can be controlled to rotate to a suitable position.
[0035] The joint part 32 includes a fixed bracket 321 connected to the turntable 312, a steering gear B322 is fixedly connected to the fixed bracket 321, an inverted U-shaped frame A323 is fixed to the output end of the steering gear B322, a steering gear C324 is connected to the outer end of the inverted U-shaped frame A323, an inverted U-shaped frame B325 is connected to the output end of the steering gear C324, a steering gear D326 is connected to the outer end of the inverted U-shaped frame B325, and an inverted U-shaped frame C327 is connected to the output end of the steering gear D326. Specifically, the steering gear B322, the steering gear C324 and the steering gear D326 can be used to control the inverted U-shaped frame A323, the inverted U-shaped frame B325 and the inverted U-shaped frame C327 to rotate and adjust to a suitable position, so that the clamping claw part 34 can grab or place objects.
[0036] The gripper portion controls the rotating member 33 to be a steering gear E fixed to the outer end surface of the inverted U-shaped frame C327. Specifically, the steering gear E can be used to rotate the object at a suitable angle so that the object can be neatly stored in a suitable position.
[0037] The clamping claw part 34 includes a mounting plate 341 connected to the output end of the steering gear E, two mutually meshing half gear plates 342 are rotatably connected to the mounting plate 341, and a steering gear F343 for driving and controlling one of the half gear plates 342 is fixed to the mounting plate 341, and the outer ends of the two half gear plates 342 are hinged with clamping arms 344, and the middle of the clamping arms 344 and the outer end of the mounting plate 341 are hinged with connecting rods 345. Specifically, as Figure 1-Figure 4The servo F343 can be used to control the opening of the two half-gear plates 342 that are in an eight-shaped shape and mesh with each other to open or close, and the connecting rod 345 can be used to make the openings of the two clamping arms 344 close or open. This design makes it easy to grab or put down objects.
[0038] Timer D16 and timer E17 are used to output 50 Hz PWM waves to control servos A311, B322, C324, D326, E, and F343 in the robotic arm mechanism 3.
[0039] It should also be noted that the installation, debugging and control operation process of the present application is as follows: first, the serial port is configured so that the serial port of the single-chip microcomputer 12 has the functions of sending and receiving; the timer C15 of the single-chip microcomputer 12 is configured to output a 10khz PWM wave, and the relevant GPIO port is configured to control the drive motor 24 through the tb6612 motor driver chip; the timer A13 and timer B14 of the single-chip microcomputer 12 are configured to the encoder mode for speed measurement and PID control of the drive motor 24; the timer D16 and timer E17 of the single-chip microcomputer 12 are configured to output a 50hz PWM wave to control the servos A311, B322, C324, D326, E and F343 of the robotic arm mechanism 3 to realize mechanical control of the robotic arm mechanism 3 for object grabbing.
[0040] It should also be noted that the PID control process of the present application is: first calculate the error E between the target speed value and the actual speed value measured by the encoder, and through discretization, replace the differential with the differential, and replace the integral with the accumulation, and substitute it into the PID formula for calculation to obtain the output signal, that is, the PWM duty cycle.
[0041] Rubber protective plates 18 are fixedly connected to both the front and rear sides of the bottom of the housing 11. Figure 1 As shown, the outer end of the rubber protective plate 18 exceeds the front and rear ends of the driving mechanism 2 and the front and rear ends of the housing 11. The rubber protective plate 18 can provide anti-collision protection for the tracked object transport vehicle.
[0042] When using this application:
[0043] The driving motor 24 is controlled by the timer C15 of the single chip 12. After the driving motor 24 is started, the corresponding rotating shaft 23 rotates, and the outer shell 11 at the top of the fixed plate 21 is indirectly driven by the crawler 26 to move, so that the crawler object conveyor is transferred to the object picking location; after the steering gear A311 is started, it can be used to control the turntable 312 to rotate to a suitable position. The steering gear B322, the steering gear C324 and the steering gear D326 can be used to control the inverted U-shaped frame A323, the inverted U-shaped frame B325 and the inverted U-shaped frame C327 to rotate and adjust to a suitable position, so that the clamping claw part 34 can grab the object. The servo F343 can be used to control the opening of the two half-gear plates 342 that are in an eight-shaped and meshing relationship to open or close, and the connecting rod 345 can be used to make the openings of the two clamping arms 344 close or open. This design makes it easy to grab objects; and the servo E can be used to rotate the objects at a suitable angle so that the objects can be neatly stored in a suitable position.
[0044] It is obvious to those skilled in the art that the present application is not limited to the details of the exemplary embodiments described above, and that the present application can be implemented in other specific forms without departing from the spirit or essential features of the present application. Therefore, the embodiments should be regarded as exemplary and non-limiting in all respects, and the scope of the present application is defined by the appended claims rather than the above description, and it is intended that all changes falling within the meaning and scope of the equivalent elements of the claims be included in the present application. Any reference numeral in a claim should not be regarded as limiting the claim to which it relates.
Claims
1. A crawler object conveyor based on an improved pid algorithm, characterized in that: include A driving mechanism (2), comprising a driving motor (24); Robotic arm mechanism (3); The main control mechanism (1) comprises a housing (11) and a single-chip microcomputer (12) arranged therein; the single-chip microcomputer (12) is provided with a timer A (13) and a timer B (14) in a coding mode for measuring the speed and PID control of the drive motor (24); the single-chip microcomputer (12) is provided with a timer C (15) for controlling the start and stop of the drive motor (24); the single-chip microcomputer (12) is also provided with a timer D (16) and a timer E (17) for controlling the mechanical arm mechanism (3).
2. The crawler object transport vehicle based on the improved pid algorithm according to claim 1, characterized in that: The driving mechanism (2) comprises a fixing plate (21) connected to the bottom end surface of the housing (11), mounting blocks (22) are fixed on four sides of the bottom end surface of the fixing plate (21), each of the mounting blocks (22) is rotatably connected to a rotating shaft (23), and the driving motor (24) whose output shaft is connected to the corresponding rotating shaft (23) is fixedly mounted on two mounting blocks (22) located on different sides of the fixing plate (21), each of the rotating shafts (23) is connected to a track wheel (25) at its outer end, and a track (26) is tensioned on the two track wheels (25) on the same side.
3. The crawler object transport vehicle based on the improved pid algorithm according to claim 1, characterized in that: The timer C (15) is used to output a 10 kHz PWM wave and configure a corresponding GPIO port to control the drive motor (24) through a tb6612 motor drive chip.
4. The crawler object transport vehicle based on the improved pid algorithm according to claim 1, characterized in that: The mechanical arm mechanism (3) comprises a rotating base member (31) mounted on the top of the housing (11) and a joint member (32) driven by the rotating base member (31) and capable of adjusting its position up and down and forward and backward, wherein a clamping claw portion (33) is provided at the outer end of the joint member (32) to control the rotating member, and a clamping claw portion (34) is provided at the outer end of the clamping claw portion to control the rotating member (33).
5. The crawler object transport vehicle based on the improved pid algorithm according to claim 4, characterized in that: The rotating base member (31) comprises a steering gear A (311) installed on the top of the housing (11); an output end of the steering gear A (311) can pass through the top wall of the housing (11), and is provided with a rotating disk (312) in contact with the top of the housing (11).
6. The crawler object transport vehicle based on the improved pid algorithm according to claim 5, characterized in that: The joint component (32) comprises a fixed bracket (321) connected to the rotating disk (312), a steering gear B (322) being fixedly connected to the fixed bracket (321), an inverted U-shaped frame A (323) being fixed to the output end of the steering gear B (322), a steering gear C (324) being connected to the outer end of the inverted U-shaped frame A (323), an inverted U-shaped frame B (325) being connected to the output end of the steering gear C (324), a steering gear D (326) being connected to the outer end of the inverted U-shaped frame B (325), and an inverted U-shaped frame C (327) being connected to the output end of the steering gear D (326).
7. The crawler object transport vehicle based on the improved pid algorithm according to claim 6, characterized in that: The clamping claw portion controlling rotating member (33) is a steering gear E fixed to the outer end surface of the inverted U-shaped frame C (327).
8. The crawler object transport vehicle based on the improved PID algorithm according to claim 7, characterized in that: The clamping claw portion (34) comprises a mounting plate (341) connected to the output end of the steering gear E, two mutually meshing half gear plates (342) are rotatably connected to the mounting plate (341), and a steering gear F (343) for driving and controlling one of the half gear plates (342) is fixed to the mounting plate (341), the outer ends of the two half gear plates (342) are hinged with clamping arms (344), and a connecting rod (345) is hinged between the middle of the clamping arm (344) and the outer end of the mounting plate (341).
9. The crawler object transport vehicle based on the improved PID algorithm according to claim 8, characterized in that: The timer D (16) and the timer E (17) are used to output a 50 Hz PWM wave to control the steering gear A (311), the steering gear B (322), the steering gear C (324), the steering gear D (326), the steering gear E, and the steering gear F (343) in the mechanical arm mechanism (3).
10. The crawler object transport vehicle based on the improved PID algorithm according to claim 1, characterized in that: Rubber protective plates (18) are fixedly connected to both the front and rear sides of the bottom of the housing (11).
Citation Information
Patent Citations
Crawler-type automatic exploration robot
CN107399378A
Intelligent handling vehicle
CN207851615U
Mechanical arm grabbing device for pharmacy
CN220446505U
