A three-dimensional mapping track robot control system and robot
Through the three-dimensional map construction orbital robot control system, the motion control platform and stable servo platform are used, combined with gyroscopes and laser ranging sensors, the precision problem of factory warehouse material management is solved, and the low-cost and efficient three-dimensional map construction and materials are achieved. Management improves the efficiency and accuracy of warehouse planning.
Patent Information
- Application Number
- CN202211049669.0
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-08-30
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2042-08-30
AI Technical Summary
The material management of factory warehouses is chaotic, and precise, standardized and standardized management cannot be achieved, resulting in waste of resources and labor. The existing two-dimensional floor plan planning methods are time-consuming and labor-intensive and cannot meet the needs of large warehouses.
Design a three-dimensional map construction track robot control system, including a motion control platform and a stable servo platform, and use sensor mechanisms such as gyroscopes, laser ranging sensors and cameras to realize accurate three-dimensional map construction and model updates of factories or warehouses to realize Point-to-point material management.
It realizes that the three-dimensional map construction robot is low-cost and easy to maintain, and can quickly and accurately establish real-life models in complex scenarios, improves the work efficiency of factory warehouse planning, and ensures the accuracy and reliability of object scanning.
Smart Images

Figure CN115502951B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robot technology, and in particular to a three-dimensional mapping track robot control system and a robot. Background Art
[0002] At present, there are many and diverse materials in factory warehouses, and manual management is relatively chaotic. The quantity is unclear, and it is impossible to do accurate, standardized, and regular management. In addition, inventory of remaining materials in the warehouse is time-consuming and labor-intensive, resulting in a huge waste of resources and labor. It is necessary to establish a real-life model corresponding to the scene environment and plan the location in the scene. However, in this case, a two-dimensional plane map is generally used for operation. Since factory warehouses are generally large, a two-dimensional plane map is required. Figure 1 Each map will be planned, which takes a long time. Therefore, a three-dimensional mapping track robot control system and a robot are proposed to solve the above problems. Summary of the invention
[0003] In view of this, the present invention provides a three-dimensional mapping track robot control system and a robot. The three-dimensional mapping robot has low cost, is easy to maintain, and has accurate model building. It can complete model building for factories or warehouses, and update point-to-point model building, thereby realizing accurate, standard parts, and information management of materials.
[0004] In order to solve the above technical problems, the present invention provides a three-dimensional mapping track robot control system, including a motion control platform and a stable servo platform, the motion control platform is used to control the movement of the track robot, and the stable servo platform is used to rotate the scanning part on the track robot;
[0005] The motion control platform includes a processor, a controller power module, a network module, an interface module, an I / O signal communication module, a safety loop module, a system detection module and a drive module, wherein the controller power module, the network module, the interface module, the I / O signal communication module, the safety loop module and the system detection module are all electrically connected to the processor, and the drive module is electrically connected to the controller power module;
[0006] The system comprises a motor drive control board, a gyroscope data processing module, a gyroscope acquisition module, a gyroscope module, a drive module, a photoelectric detection communication interface module, and a laser ranging sensor module. The gyroscope data processing module, the drive module, and the photoelectric detection communication interface module are all connected to the motor drive control board, the gyroscope data processing module is connected to the gyroscope acquisition module, the gyroscope acquisition module is connected to the gyroscope module, and the photoelectric detection communication interface module is connected to the laser ranging sensor module.
[0007] Furthermore, the controller power module includes an MCU controller, a battery redundancy circuit, a charging circuit, a charging management circuit, a communication module, an isolated input and output circuit, a 4G remote control circuit, a system power circuit, a detection circuit, and an output power control circuit; and the battery redundancy circuit, the charging circuit, the charging management circuit, the communication module, the isolated input and output circuit, the 4G remote control circuit, the system power circuit, the detection circuit, and the output power control circuit are all connected to the MCU controller.
[0008] Furthermore, the interface module includes a high-speed communication interface, a lithium battery communication interface, and an obstacle avoidance radar interface.
[0009] Furthermore, the gyroscope module includes two single-axis gyroscope modules, one of which is a transverse gyroscope module, and the other is a longitudinal gyroscope module.
[0010] Furthermore, the driving module includes a motor 1, a motor 1 resolver module, a motor 2, and a motor 2 resolver module, and the motor 1 and the motor 2 control the transverse gyroscope module and the longitudinal gyroscope module respectively.
[0011] Furthermore, the gyroscope data processing module includes a MEMS gyroscope signal processing circuit and an angular velocity sensor signal processing circuit.
[0012] A three-dimensional mapping track robot, comprising a control system connected inside the robot, wherein the control system is the above control system, and further comprises:
[0013] A sliding frame, wherein a mounting groove is provided on the upper portion of the sliding frame;
[0014] A driving mechanism, used for driving the robot to move as a whole, wherein the driving mechanism is slidably suspended on the track and is arranged in the mounting groove;
[0015] A gyroscope, wherein the gyroscope is mounted below the sliding frame;
[0016] The sensor mechanism is used for scanning the factory warehouse to realize mapping, and the sensor mechanism is installed on the gyroscope.
[0017] Furthermore, the driving structure includes a driving wheel connected to the middle of the mounting groove, and both ends of the driving wheel are provided with guide frames connected to the mounting groove.
[0018] Furthermore, the sensing mechanism includes a flip frame connected to the gyroscope, and a sensing head is movably connected to the flip frame.
[0019] Furthermore, the sensor head is connected to a laser sensor, and a camera connected to the sensor head is arranged below the laser sensor.
[0020] The beneficial effects of the above technical solution of the present invention are as follows:
[0021] 1. The 3D mapping robot is low-cost, easy to maintain, and can build models accurately. It can complete model building for factories or warehouses, and update models point-to-point, realizing accurate, standard parts, and information management of materials. It can enable rail robots to be used in complex scenes, and better build real-life models of the on-site environment in real time, ensuring the accuracy and reliability of object scanning, and effectively improving the work efficiency of factory warehouse planning.
[0022] 2. The functional integrity of the whole machine can be ensured through model building, calculation, and reasonable selection of electrical components of the motion control platform and stable servo platform. The stress conditions of the structure and electronic system under environmental tests can be calculated through structural simulation to ensure that the design requirements are met. The system can be modified and improved through test software and MATLAB-assisted calculations to ensure the reliability and integrity of the control strategy.
[0023] 3. The track robot adopts a single-wheel drive with a driving wheel that contacts the track to drive the sliding frame to move. The guide frame can limit the sliding frame on the track. The guide frame operates in a clamping and fixed manner. The walking mode adopts a position control method. The track robot can arbitrarily specify the absolute position in the track for control scanning.
[0024] 4. Use the motion control platform to drive the track robot to move and achieve precise movement of the robot. The vector algorithm model avoids too many unnecessary mathematical operations, thereby reducing execution efficiency. The stable servo platform can adjust the angle of the laser ranging sensor to facilitate scanning by the laser ranging sensor. BRIEF DESCRIPTION OF THE DRAWINGS
[0025] Figure 1 It is a schematic diagram of the structure of the motion control platform of the present invention;
[0026] Figure 2 It is a schematic diagram of the structure of a stable servo platform of the present invention;
[0027] Figure 3 It is a schematic diagram of the structure of the track robot of the present invention;
[0028] Figure 4 is a three-dimensional schematic diagram of the robot structure of the present invention;
[0029] Figure 5 It is a front view schematic diagram of the sliding frame structure of the present invention;
[0030] Figure 6 It is a side view schematic diagram of the sliding frame structure of the present invention;
[0031] Figure 7 It is a top view schematic diagram of the sliding frame structure of the present invention;
[0032] Figure 8 The figure is a working flow chart of the track robot system of the present invention.
[0033] In the figure: 1. Sliding frame; 2. Mounting slot; 3. Guide frame; 4. Driving wheel; 5. Flip frame; 6. Sensor head; 7. Laser sensor; 8. Camera; 9. Obstacle avoidance sensor; 10. Safety sensor; 11. Status indicator light; 12. Antenna; 13. Charging brush head; 14. Card reader; 15. Gyroscope. DETAILED DESCRIPTION
[0034] To make the purpose, technical solution and advantages of the embodiments of the present invention clearer, the following will be combined with the appended drawings of the embodiments of the present invention. Figure 1-8 , the technical scheme of the embodiment of the present invention is clearly and completely described. Obviously, the described embodiment is a part of the embodiment of the present invention, not all of the embodiments. Based on the described embodiment of the present invention, all other embodiments obtained by ordinary technicians in this field belong to the scope of protection of the present invention.
[0035] like Figure 5 and Figure 6 As shown, in one embodiment, a three-dimensional mapping track robot includes a control system connected to the inside of the robot, and also includes a sliding frame 1, a driving mechanism, a gyroscope 15, and a sensing mechanism. A mounting groove 2 is opened above the sliding frame 1, and the driving mechanism is slidably suspended on the track. The driving mechanism is arranged in the mounting groove 2 to drive the robot to move as a whole. The gyroscope 15 is installed below the sliding frame 1, and the sensing mechanism is installed on the gyroscope 15, which is used to scan the factory warehouse to achieve mapping.
[0036] The driving mechanism can drive the sliding frame 1 to move, and the sliding frame 1 can drive the sensor head 6 to move at the same time, so that the sensor head 6 scans the object, and the gyroscope 15 can ensure the stability of the sensor head 6.
[0037] like Figure 7 and Figure 8 As shown, an antenna 12 is fixedly connected to the lower part of one end of the sliding frame 1, and the antenna 12 can enhance the signal reception and transmission on the sliding frame 1. A charging brush head 13 is fixedly installed on one side of the upper part of the sliding frame 1, and the charging brush head 13 can facilitate the connection of an external power source. A card reader 14 is connected to the other side of the upper part of the sliding frame 1, and the card reader 14 facilitates the input of external storage programs and contents into the interior of the sliding frame 1.
[0038] like Figure 6 and Figure 7As shown, status indicator lights 11 are connected to both sides of the sliding frame 1, and the status indicator lights 11 can clearly indicate the working status of the sliding frame 1. Four obstacle avoidance sensors 9 are symmetrically connected to both ends of the sliding frame 1. The obstacle avoidance sensors 9 are AGV obstacle avoidance sensors. A safety sensor 10 located on the sliding frame 1 is arranged between two adjacent obstacle avoidance sensors 9, and the safety sensor 10 is a PSEN safety sensor.
[0039] In this embodiment, the coordination between the obstacle avoidance sensor 9 and the safety sensor 10 can ensure the safety of the robot and prevent the robot from being damaged by collision with external objects.
[0040] like Figure 8 As shown, in one embodiment, the driving structure includes a driving wheel 4 connected to the middle of the mounting groove 2, and both ends of the driving wheel 4 are provided with a guide frame 3 connected to the mounting groove 2.
[0041] In this embodiment, the track robot adopts a single-wheel drive of the driving wheel 4 and contacts with the track to drive the sliding frame 1 to move. The guide frame 3 can limit the sliding frame 1 on the track. The guide frame 3 operates in a clamping and fixed manner, and the walking mode adopts a position control mode. The track robot can arbitrarily specify the absolute position in the track for control scanning.
[0042] like Figure 6 and Figure 7 As shown, in one embodiment, the sensing mechanism includes a flip frame 5 connected to a gyroscope 15, a sensor head 6 is movably connected to the flip frame 5, a laser sensor 7 is connected to the sensor head 6, the laser sensor 7 is an HL-G103 laser sensor, and a camera 8 connected to the sensor head 6 is arranged below the laser sensor 7.
[0043] In this embodiment, the coordination between the flip frame 5, the laser sensor 7 and the camera 8 enables the rail robot to better establish a real-scene model of the on-site environment in real time in complex scenes, ensuring the accuracy and reliability of scanning the surrounding environment and effectively improving the efficiency of factory warehouse planning.
[0044] The setting of the flip frame 5 can make the scanning area of the flip frame 5 90 degrees * 90 degrees, the mapping resolution of the laser sensor 7 is adjustable, the output frequency of the laser sensor is 1000p / s, the time required to scan the entire image is less than 1 minute, and the maximum time at full resolution does not exceed 5 minutes.
[0045] like Figure 1 As shown: In one embodiment, a three-dimensional mapping track robot control system includes a motion control platform and a stable servo platform, the motion control platform is used to control the movement of the track robot, and the stable servo platform is used to rotate the scanning part on the track robot;
[0046] The motion control platform includes a processor, a controller power module, a network module, an interface module, an I / O signal communication module, a safety loop module, a system detection module and a drive module. The controller power module, the network module, the interface module, the I / O signal communication module, the safety loop module and the system detection module are all electrically connected to the processor, the drive module is electrically connected to the controller power module, and the interface module includes a high-speed communication interface, a lithium battery communication interface and an obstacle avoidance radar interface.
[0047] The processor is an ARM processor to meet the robot's control motion, peripherals, posture solution, safety link, charging and other loop functions. The drive module uses DRV8313 as the motor hardware driver. The software part needs to build a closed-loop control system based on DRV8313 and the mathematical model of the torque motor and the encoder to achieve the purpose of controlling the torque motor. The torque motor vector algorithm model analyzes the relationship between the motor PWM output and the speed as follows:
[0048] The PWM signal is a pulse signal with a constant frequency and a pulse width that changes according to the output signal of the correction link. When a controller is used to generate a PWM signal, the equivalent average voltage U pwm Satisfies the following expression:
[0049]
[0050] In the above formula, τ is the high level duration of the PWM signal; T pwm is the period of PWM; U 10 It is the operating voltage of the controller chip I / O.
[0051] According to the working principle of the unidirectional PWM module, when the period register and the comparison register values are R prd , R cmp The above formula can be changed accordingly.
[0052] In actual digital controller design, the absolute value of the correction link output is usually sent to the PWM comparison register. Therefore, the transfer function between the equivalent average voltage of the PWM output pin and the PWM module comparison register is:
[0053]
[0054] PWM output is similar to the digital DAC module, but in actual use, it must be limited to ensure that the PWM duty cycle must be less than 90%. The limiter module can design the corresponding saturation link mathematical model according to the actual situation.
[0055] The system detection module includes a current detection module and a voltage detection module. The interface module includes a high-speed communication interface, a lithium battery communication interface, and an obstacle avoidance radar interface. The network module includes a Wifi receiving module and a Wifi transmission module. The drive module uses a brushless DC motor as the driver of the motion control platform, and the drive module uses DRV8313 as the motor hardware driver.
[0056] In this embodiment, a motion control platform is used to drive the track robot to move, thereby achieving precise movement of the robot, wherein the vector algorithm model avoids excessive unnecessary mathematical operations and thus reduces execution efficiency.
[0057] like Figure 2 As shown, the stable servo platform includes a motor drive control board, a gyroscope data processing module, a gyroscope acquisition module, a gyroscope module, a drive module, a photoelectric detection communication interface module, and a laser ranging sensor module. The gyroscope data processing module, the drive module, and the photoelectric detection communication interface module are all connected to the motor drive control board, the gyroscope data processing module is connected to the gyroscope acquisition module, the gyroscope acquisition module is connected to the gyroscope module, the photoelectric detection communication interface module is connected to the laser ranging sensor module, the gyroscope module includes two single-axis gyroscope modules, one of which is a lateral gyroscope module, and the other is a longitudinal gyroscope module, which is convenient for adjusting the angle and position of the sensing mechanism, the drive module includes a motor 1, a motor 1 rotary transformer module, a motor 2, and a motor 2 rotary transformer module, the motor 1 and the motor 2 respectively control the lateral gyroscope module and the longitudinal gyroscope module, the motor 1 and the motor 2 are both AC motors, which can realize the mutual conversion between mechanical energy and AC electric energy, and the gyroscope data processing module includes a MEMS gyroscope signal processing circuit and an angular velocity sensor signal processing circuit.
[0058] In this embodiment, the gyroscope module is used to ensure the stability of the sensing mechanism of the rail robot. The cooperation between the gyroscope data processing module and the gyroscope acquisition module can collect the gyroscope data and convert it into a digital signal, so that the driving module drives the gyroscope module to work and realizes the sensing mechanism on the gyroscope to scan the surroundings.
[0059] like Figure 3 As shown, in one embodiment, the controller power module includes an MCU controller, a battery redundancy circuit, a charging circuit, a charging management circuit, a communication module, an isolated input and output circuit, a 4G remote control circuit, a system power circuit, a detection circuit, and an output power control circuit. The battery redundancy circuit, the charging circuit, the charging management circuit, the communication module, the isolated input and output circuit, the 4G remote control circuit, the system power circuit, the detection circuit, and the output power control circuit are all connected to the MCU controller.
[0060] The communication module is connected with a communication interface circuit. The communication module is connected with a communication interface circuit. The detection circuit includes a current detection circuit, a temperature detection circuit, and a battery voltage detection circuit. The communication module is an isolated 485 communication.
[0061] In this embodiment, the entire circuit system can be monitored by utilizing the coordination between various circuits and modules, thereby preventing problems in the circuit system from affecting the normal use of the device.
[0062] like Figure 4 As shown, it is the working flow chart of the track robot system of the present invention:
[0063] Step A: Power on the robot and start it;
[0064] Step B: The system detection module detects whether the entire robot system is normal;
[0065] Step C: The host computer sends the corresponding position task command, and the robot will move to the corresponding position through the drive module. While the robot is moving, the host computer sets the scanning area instruction, the gyroscope module follows the movement of the robot, and the laser ranging sensor module realizes laser scanning and mapping to generate a point cloud image of the corresponding area;
[0066] Step D: The laser ranging sensor module transmits the information to the computer so that the computer calculates its volume;
[0067] Step E: After the movement, the track robot will move to the standby position;
[0068] Step F: When the host computer outputs a command again, the robot works in this cycle.
[0069] In the present invention, unless otherwise clearly stipulated and limited, for example, it can be a fixed connection, a detachable connection, or an integrated one; it can be a mechanical connection or an electrical connection; it can be directly connected or indirectly connected through an intermediate medium, it can be the internal connection of two elements or the interaction relationship between two elements. Unless otherwise clearly defined, for ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to the specific circumstances.
[0070] The above is a preferred embodiment of the present invention. It should be pointed out that for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principles of the present invention. These improvements and modifications should also be regarded as the scope of protection of the present invention.
Claims
1. A three-dimensional mapping track robot, characterized in that: It includes a motion control platform and a stable servo platform. The motion control platform is used to control the movement of the track robot, and the stable servo platform is used to rotate the scanning parts on the track robot. The motion control platform includes a processor, a controller power module, a network module, an interface module, an I / O signal communication module, a safety loop module, a system detection module and a drive module, wherein the controller power module, the network module, the interface module, the I / O signal communication module, the safety loop module and the system detection module are all electrically connected to the processor, and the drive module is electrically connected to the controller power module; The stable servo platform comprises a motor drive control board, a gyroscope data processing module, a gyroscope acquisition module, a gyroscope module, a drive module, a photoelectric detection communication interface module, and a laser ranging sensor module. The gyroscope data processing module, the drive module, and the photoelectric detection communication interface module are all connected to the motor drive control board, the gyroscope data processing module is connected to the gyroscope acquisition module, the gyroscope acquisition module is connected to the gyroscope module, and the photoelectric detection communication interface module is connected to the laser ranging sensor module. Also includes: A sliding frame (1), wherein a mounting groove (2) is formed on the top of the sliding frame (1); A driving mechanism, used for driving the robot to move as a whole, the driving mechanism being slidably suspended on the track, and the driving mechanism being arranged in the mounting groove (2); A gyroscope (15), wherein the gyroscope (15) is mounted below the sliding frame (1); A sensor mechanism, used for scanning the factory warehouse to realize mapping, wherein the sensor mechanism is mounted on a gyroscope (15); The driving mechanism comprises a driving wheel (4) connected to the middle of the mounting groove (2), and guide frames (3) connected to the mounting groove (2) are provided at both ends of the driving wheel (4).
2. The three-dimensional mapping track robot according to claim 1, characterized in that: The controller power module includes an MCU controller, a battery redundancy circuit, a charging circuit, a charging management circuit, a communication module, an isolated input and output circuit, a 4G remote control circuit, a system power circuit, a detection circuit, and an output power control circuit. The battery redundancy circuit, the charging circuit, the charging management circuit, the communication module, the isolated input and output circuit, the 4G remote control circuit, the system power circuit, the detection circuit, and the output power control circuit are all connected to the MCU controller.
3. The three-dimensional mapping track robot according to claim 1, characterized in that: The interface module includes a high-speed communication interface, a lithium battery communication interface, and an obstacle avoidance radar interface.
4. The three-dimensional mapping track robot according to claim 1, characterized in that: The gyroscope module includes two single-axis gyroscope modules, one of which is a transverse gyroscope module, and the other is a longitudinal gyroscope module.
5. The three-dimensional mapping track robot according to claim 1, characterized in that: The driving module includes a first motor, a first motor resolver module, a second motor, and a second motor resolver module. The first motor and the second motor control a transverse gyroscope module and a longitudinal gyroscope module respectively.
6. The three-dimensional mapping track robot according to claim 1, characterized in that: The gyroscope data processing module includes a MEMS gyroscope signal processing circuit and an angular velocity sensor signal processing circuit.
7. The three-dimensional mapping track robot according to claim 1, characterized in that: The sensing mechanism comprises a flip frame (5) connected to a gyroscope (15), and a sensing head (6) is movably connected to the flip frame (5).
8. The three-dimensional mapping track robot according to claim 7, characterized in that: The sensor head (6) is connected to a laser sensor (7), and a camera (8) connected to the sensor head (6) is arranged below the laser sensor (7).
