CN117434949A - A multi-sensor target docking system for commercial vehicle transfer robots - Google Patents
A multi-sensor target docking system for commercial vehicle transfer robots Download PDFInfo
- Publication number
- CN117434949A CN117434949A CN202311431503.XA CN202311431503A CN117434949A CN 117434949 A CN117434949 A CN 117434949A CN 202311431503 A CN202311431503 A CN 202311431503A CN 117434949 A CN117434949 A CN 117434949A
- Authority
- CN
- China
- Prior art keywords
- module
- transfer robot
- commodity
- robot
- commodity car
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000012546 transfer Methods 0.000 title claims abstract description 133
- 238000003032 molecular docking Methods 0.000 title claims abstract description 28
- 238000012937 correction Methods 0.000 claims abstract description 36
- 230000007246 mechanism Effects 0.000 claims abstract description 35
- 238000001514 detection method Methods 0.000 claims abstract description 24
- 230000033001 locomotion Effects 0.000 claims abstract description 23
- 238000004891 communication Methods 0.000 claims description 62
- 230000009471 action Effects 0.000 claims description 17
- 239000003638 chemical reducing agent Substances 0.000 claims description 13
- 238000000034 method Methods 0.000 claims description 6
- 230000001960 triggered effect Effects 0.000 claims description 5
- 230000032258 transport Effects 0.000 claims description 4
- 238000011217 control strategy Methods 0.000 claims description 3
- 230000008569 process Effects 0.000 claims description 3
- 230000008447 perception Effects 0.000 claims description 2
- 230000000007 visual effect Effects 0.000 claims description 2
- 210000001503 joint Anatomy 0.000 claims 2
- 230000004888 barrier function Effects 0.000 claims 1
- 210000000078 claw Anatomy 0.000 description 7
- OKTJSMMVPCPJKN-UHFFFAOYSA-N Carbon Chemical compound [C] OKTJSMMVPCPJKN-UHFFFAOYSA-N 0.000 description 4
- 229910052799 carbon Inorganic materials 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 4
- 239000000203 mixture Substances 0.000 description 4
- 238000009434 installation Methods 0.000 description 3
- 229910000831 Steel Inorganic materials 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 238000005096 rolling process Methods 0.000 description 2
- 239000010959 steel Substances 0.000 description 2
- 239000002699 waste material Substances 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 238000003763 carbonization Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000026058 directional locomotion Effects 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000000670 limiting effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000001737 promoting effect Effects 0.000 description 1
- 230000000717 retained effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Landscapes
- Manipulator (AREA)
Abstract
本发明公开的一种商品车转运机器人多传感器目标对接系统,属于机器人运动驱动与控制技术领域。本发明主要由机器人车架、商品车定位定向模块、机身内部纠偏模块、四周障碍物检测模块、装夹模块组成。机器人车架呈矩形,内含空腔,用于承载商品车。商品车定位定向模块由安装在机器人顶部前方的伺服转台,和安装在伺服转台上的激光雷达、可见光摄像机、红外摄像机组成,实现商品车车身定位定向。机身内部纠偏模块由安装在四个装夹模块夹爪中间的激光雷达组成,实现商品车轮胎定位定向。四周障碍物检测模块由安装在机器人四周激光雷达组成;装夹模块由升降机构、轴距调整机构和夹爪摆动机构组成,通过抱夹轮胎,进而稳定抬起商品车。
The invention discloses a multi-sensor target docking system for a commercial vehicle transfer robot, which belongs to the technical field of robot motion drive and control. The invention mainly consists of a robot frame, a commercial vehicle positioning and orientation module, an internal deviation correction module of the fuselage, a surrounding obstacle detection module, and a clamping module. The robot frame is rectangular and contains a cavity for carrying commercial vehicles. The commercial vehicle positioning and orientation module consists of a servo turntable installed in front of the top of the robot, and a laser radar, visible light camera, and infrared camera installed on the servo turntable to realize the positioning and orientation of the commercial vehicle body. The internal deviation correction module of the fuselage consists of a laser radar installed in the middle of the clamping jaws of four clamping modules to realize the positioning and orientation of commercial vehicle tires. The surrounding obstacle detection module consists of laser radar installed around the robot; the clamping module consists of a lifting mechanism, a wheelbase adjustment mechanism and a clamping jaw swing mechanism. It clamps the tires to steadily lift the commercial vehicle.
Description
技术领域Technical field
本发明涉及机器人对接技术领域的一种多传感器目标对接系统,尤其涉及一种商品车转运机器人多传感器目标对接系统,属于机器人运动驱动与控制技术领域。The invention relates to a multi-sensor target docking system in the field of robot docking technology, and in particular to a multi-sensor target docking system for a commercial vehicle transfer robot, which belongs to the technical field of robot motion drive and control.
背景技术Background technique
智慧绿色已成为推动港口发展变革的重要标志。在整车物流链中,汽车码头是整车物流链中重要的节点,对港口物流至关重要。然而,传统的汽车码头操作方式主要依赖人工,导致效率低下、资源浪费、高碳排放、堵塞和安全问题频发。商品车转运机器人是一种应用于自动化转运商品车的智能化装备,通过商品车转运机器人自主完成商品车运输和转运任务,降低人工成本,提高了运输效率、安全性和操作准确性,有助于减少碳排放,促进环境可持续性,为整个港口物流体系带来显著改进,目前尚未存在利用移动机器人对接商品车的案例。Smart green has become an important symbol of promoting port development and reform. In the vehicle logistics chain, the vehicle terminal is an important node in the vehicle logistics chain and is crucial to port logistics. However, the traditional automobile terminal operation method mainly relies on manual labor, resulting in low efficiency, resource waste, high carbon emissions, congestion and frequent safety problems. The commodity vehicle transfer robot is an intelligent equipment used for automated transportation of commodity vehicles. The commodity vehicle transfer robot independently completes the transportation and transfer tasks of commodity vehicles, reduces labor costs, improves transportation efficiency, safety and operational accuracy, and helps In order to reduce carbon emissions, promote environmental sustainability, and bring significant improvements to the entire port logistics system, there is currently no case of using mobile robots to dock commercial vehicles.
发明内容Contents of the invention
针对于汽车码头商品车转运依赖大量人力、安全性差、碳排放量巨大的问题,本发明的主要目的是提供一种商品车转运机器人多传感器目标对接系统,该系统安装在一种商品车转运机器人上,实现商品车转运机器人对目标商品车定位定向、对接纠偏、抱夹取车、障碍物检测等功能,实现商品车转运机器人自主搬运商品车,解决汽车码头人力资源浪费严重、工作效率低下、碳排放量巨大等问题,提高了汽车码头的工作效率。In view of the problems that the transfer of commercial vehicles at automobile terminals relies on a large amount of manpower, poor safety, and huge carbon emissions, the main purpose of the present invention is to provide a multi-sensor target docking system for a commercial vehicle transfer robot. The system is installed on a commercial vehicle transfer robot. On the platform, the commercial vehicle transfer robot can realize the functions of positioning and orientation of the target commodity vehicle, docking and deviation correction, clamping and picking up the vehicle, and obstacle detection, etc., and realize the commodity vehicle transfer robot to autonomously transport the commodity vehicle, solving the serious waste of human resources and low work efficiency at the automobile terminal. Problems such as huge carbon emissions have improved the working efficiency of automobile terminals.
本发明的目的是通过如下技术方案实现的:The purpose of the present invention is achieved through the following technical solutions:
一种商品车转运机器人多传感器目标对接系统,由商品车转运机器人车架、商品车定位定向模块、机身内部纠偏模块、四周障碍物检测模块、装夹模块、控制与通信模块、组合导航模块七大部分组成。A multi-sensor target docking system for a commercial vehicle transfer robot, which consists of a commercial vehicle transfer robot frame, a commercial vehicle positioning and orientation module, an internal correction module of the fuselage, a surrounding obstacle detection module, a clamping module, a control and communication module, and a combined navigation module Composed of seven parts.
商品车转运机器人车架由钢筋搭建而成,呈矩形,内含空腔,用于承载商品车。商品车定位定向模块、机身内部纠偏模块、四周障碍物检测模块、装夹模块、控制与通信模块、组合导航模块均安装在商品车转运机器人车架上。The frame of the commercial vehicle transfer robot is made of steel bars and is rectangular in shape with a cavity inside for carrying commercial vehicles. The commercial vehicle positioning and orientation module, fuselage internal correction module, surrounding obstacle detection module, clamping module, control and communication module, and integrated navigation module are all installed on the commercial vehicle transfer robot frame.
商品车定位定向模块由多线激光雷达、可见光摄像机、红外摄像机和三维伺服转台组成。多线激光雷达、可见光摄像机、红外摄像机均安装在三维伺服转台上,其中,多线激光雷达安装在三维伺服转台顶部中间位置,可见光摄像机和红外摄像机安装在多线激光雷达两侧,当三维伺服转台运动时,多线激光雷达、红外摄像机和可见光摄像机会随着三维伺服转台的运动进行运动,从而实现商品车转运机器人大范围的环境感知,将多线激光雷达检测的深度信息与红外摄像机和可见光摄像机检测的视觉信息相结合,实现对目标商品车车身定位定向。The commercial vehicle positioning and orientation module consists of multi-line lidar, visible light camera, infrared camera and three-dimensional servo turntable. Multi-line lidar, visible light camera, and infrared camera are all installed on the three-dimensional servo turntable. Among them, the multi-line lidar is installed in the middle of the top of the three-dimensional servo turntable. The visible light camera and infrared camera are installed on both sides of the multi-line lidar. When the three-dimensional servo When the turntable moves, the multi-line lidar, infrared camera and visible light camera will move with the movement of the three-dimensional servo turntable, thereby realizing the large-scale environment perception of the commercial vehicle transfer robot, and combining the depth information detected by the multi-line lidar with the infrared camera and The visual information detected by the visible light camera is combined to achieve the positioning and orientation of the target product vehicle body.
机身内部纠偏模块由安装在商品车转运机器人四个装夹模块的夹爪中间位置的四个单线激光雷达组成,用于扫描商品车轮胎。单线激光雷达安装朝下,当装夹模块运动时,单线激光雷达会随着装夹模块运动,通过范围滤波,只保留单线激光雷达采集的商品车转运机器人空腔内部环境点云信息。商品车转运机器人与目标商品车对接时,当目标商品车已处于商品车转运机器人空腔内部时,单线激光雷达近距离扫描商品车轮胎,获取商品车转运机器人内部两侧与目标商品车两边的间距,并传递给机器人控制与通信模块,将所述间距转化为纠偏控制量,实现对商品车转运机器人的纠偏控制;当商品车转运机器人对接目标商品车时,机身内部纠偏模块的前部两个单线激光雷达检测是否对齐商品车轮胎,从而控制商品车转运机器人停止运动;当商品车转运机器人停止运动后,后部装夹模块在进行轴距调整过程中,机身内部纠偏模块的后部单线激光雷达检测后部装夹模块的夹爪中心是否分别与商品车后部轮胎中央位置对齐,从而实现机器人控制与通信模块控制装夹模块下降并抱夹商品车,当后部单线激光雷达检测后部装夹模块中心与商品车轮胎中央位置没有对齐时,机器人控制与通信模块控制机器人后部的装夹模块运动,实现与商品车轮胎中央对齐,之后机器人控制与通信模块控制装夹模块下降,并抱夹商品车轮胎。The internal correction module of the fuselage consists of four single-line laser radars installed in the middle of the clamping jaws of the four clamping modules of the commercial vehicle transfer robot, which are used to scan the tires of commercial vehicles. The single-line lidar is installed facing down. When the clamping module moves, the single-line lidar will follow the movement of the clamping module and pass range filtering. Only the point cloud information of the environment inside the cavity of the commercial vehicle transfer robot collected by the single-line lidar will be retained. When the commercial vehicle transfer robot docks with the target commodity vehicle, when the target commodity vehicle is already inside the cavity of the commodity vehicle transfer robot, the single-line laser radar scans the tires of the commercial vehicle at close range to obtain the information on both sides of the interior of the commodity vehicle transfer robot and the two sides of the target commodity vehicle. The distance is passed to the robot control and communication module, which converts the distance into a correction control quantity to realize the correction control of the commercial vehicle transfer robot; when the commercial vehicle transfer robot docks with the target commodity vehicle, the front part of the correction module inside the fuselage Two single-line laser radars detect whether the commercial vehicle tires are aligned, thereby controlling the commercial vehicle transfer robot to stop moving; when the commercial vehicle transfer robot stops moving, the rear clamping module adjusts the wheelbase, and the rear deflection correction module inside the fuselage The single-line lidar detects whether the center of the clamping jaw of the rear clamping module is aligned with the center position of the rear tire of the commercial vehicle, thereby realizing the robot control and communication module to control the clamping module to descend and clamp the commercial vehicle. When the rear single-line lidar When it is detected that the center of the rear clamping module is not aligned with the center of the commercial vehicle tire, the robot control and communication module controls the movement of the clamping module at the rear of the robot to achieve alignment with the center of the commercial vehicle tire, and then the robot control and communication module controls the clamping module. Descend and clamp the tire of the commercial vehicle.
四周障碍物检测模块由安装在三维伺服转台上的毫米波雷达和安装在商品车转运机器人四周的四个多线激光雷达组成,毫米波雷达随着三维伺服转台的运动而运动,检测商品车转运机器人前方远距离的障碍物信息,商品车转运机器人四周的四个多线激光雷达检测机器人四周无死角环境障碍物信息,将障碍物点云信息传输给控制与通信模块,控制与通信模块对障碍物点云进行处理,获取障碍物距离机器人中央位置的距离,根据避障策略,控制与通信模块控制机器人停止运动或者绕路,从而躲避障碍物。The surrounding obstacle detection module consists of a millimeter-wave radar installed on a three-dimensional servo turntable and four multi-line laser radars installed around the commercial vehicle transfer robot. The millimeter-wave radar moves with the movement of the three-dimensional servo turntable to detect the transfer of commercial vehicles. Information about long-distance obstacles in front of the robot. Four multi-line laser radars around the commercial vehicle transfer robot detect information about obstacles in the environment without blind spots around the robot, and transmit the obstacle point cloud information to the control and communication module. The control and communication module detects obstacles. The object point cloud is processed to obtain the distance between the obstacle and the central position of the robot. According to the obstacle avoidance strategy, the control and communication module controls the robot to stop moving or take a detour to avoid obstacles.
装夹模块安装在商品车转运机器人车架空腔内部左前、右前、左后、右后四个位置,包括升降机构、轴距调整机构、夹爪摆动机构三部分,升降机构由伺服电机、蜗轮蜗杆减速机、滚装丝杠、导轨模块组成,实现升降动作;轴距调整机构由伺服电机、行星减速机、滚珠丝杠、导轨滑块组成,实现轴距调整动作;夹爪摆动机构由伺服电机、行星减速机、正反旋梯形丝杠、滑块摇杆机构组成,实现夹爪摆动动作,并且,每个夹爪的一边安装了红外传感器,控制与通信模块通过检测红外传感器是否触发,可以检测夹爪是否夹紧商品车轮胎。The clamping module is installed at the four positions of the left front, right front, left rear, and right rear inside the frame cavity of the commercial vehicle transfer robot. It includes three parts: a lifting mechanism, a wheelbase adjustment mechanism, and a clamping jaw swing mechanism. The lifting mechanism is composed of a servo motor and a worm gear. It is composed of reducer, rolling screw and guide rail module to realize the lifting action; the wheelbase adjustment mechanism is composed of servo motor, planetary reducer, ball screw and guide rail slider to realize the wheelbase adjustment action; the clamping jaw swing mechanism is made of servo motor , planetary reducer, forward and reverse rotating trapezoidal screw, and slider rocker mechanism to realize the swing movement of the clamping jaw. Moreover, an infrared sensor is installed on one side of each clamping jaw. The control and communication module can detect whether the infrared sensor is triggered or not. Check whether the clamping jaws clamp commercial vehicle tires.
控制与通信模块安装在商品车转运机器人内部,包含机器人控制箱、网关、交换机,用于接受商品车转运机器人商品车定位定向模块、机身内部纠偏模块、四周障碍物检测模块、装夹模块的传感器感知信息,根据内部算法与逻辑,提供控制策略,从而控制商品车转运机器人运动,同时实现与商品车转运机器人远程服务器的通讯,包含云端调度系统和汽车码头操作系统。The control and communication module is installed inside the commercial vehicle transfer robot, including the robot control box, gateway, and switch. It is used to accept the commercial vehicle transfer robot's commercial vehicle positioning and orientation module, internal correction module of the fuselage, surrounding obstacle detection module, and clamping module. The sensor senses information and provides a control strategy based on internal algorithms and logic to control the movement of the commercial vehicle transfer robot. At the same time, it realizes communication with the remote server of the commercial vehicle transfer robot, including the cloud dispatch system and the car terminal operating system.
组合导航模块包括GPS定位系统和姿态传感器,其中,GPS定位系统的定位天线安装在商品车转运机器人顶部中间位置,定向天线安装在商品车转运机器人顶部靠前位置,姿态传感器安装在商品车定位定向模块的三维伺服转台上,实现商品车转运机器人定位定向和自主导航。The integrated navigation module includes a GPS positioning system and an attitude sensor. The positioning antenna of the GPS positioning system is installed in the middle of the top of the commercial vehicle transfer robot, the directional antenna is installed in the front position of the top of the commercial vehicle transfer robot, and the attitude sensor is installed in the positioning and orienting position of the commercial vehicle. The module's three-dimensional servo turntable realizes the positioning, orientation and autonomous navigation of the commercial vehicle transfer robot.
商品车自主转运机器人接收云端调度系统下发的商品车转运任务之后,利用商品车定位定向模块对商品车远距离定位定向,动态规划对接路径,控制与通信模块控制商品车转运机器人运动;当商品车位于商品车转运机器人空腔内部时,利用机身内部纠偏模块的单线激光雷达对商品车轮胎进行定位定向,实现近距离纠偏,同时根据机身内部纠偏模块的前部单线激光雷达检测信息,控制商品车转运机器人停止运动;机器人控制与通信模块控制装夹模块调整轴距,直到机身内部纠偏模块的后部单线激光雷达对准商品车后部轮胎,进而控制与通信模块控制装夹模块抱夹商品车轮胎,抬起商品车,完成商品车转运机器人取车动作;之后,商品车转运机器人利用自主导航技术,将商品车转运到指定位置;控制与通信模块控制装夹模块的装夹模块同时下降,控制夹爪松开商品车轮胎,完成商品车转运机器人放车动作。After the commodity vehicle autonomous transfer robot receives the commodity vehicle transfer task issued by the cloud dispatching system, it uses the commodity vehicle positioning and orientation module to position and orient the commodity vehicle over a long distance, dynamically plans the docking path, and the control and communication module controls the movement of the commodity vehicle transfer robot; when the goods When the vehicle is located inside the cavity of the commercial vehicle transfer robot, the single-line lidar of the correction module inside the fuselage is used to position and orient the tires of the commercial vehicle to achieve close-range correction. At the same time, based on the front single-line lidar detection information of the correction module inside the fuselage, Control the commercial vehicle transfer robot to stop moving; the robot control and communication module controls the clamping module to adjust the wheelbase until the rear single-line lidar of the correction module inside the fuselage is aligned with the rear tire of the commercial vehicle, and then the control and communication module controls the clamping module It clamps the tire of the commercial vehicle, lifts the commercial vehicle, and completes the action of the commercial vehicle transfer robot to pick up the vehicle. After that, the commercial vehicle transfer robot uses autonomous navigation technology to transfer the commercial vehicle to the designated location; the control and communication module controls the clamping of the clamping module. The module descends at the same time, and controls the clamping claw to release the tire of the commercial vehicle, completing the release action of the commercial vehicle transfer robot.
有益效果:Beneficial effects:
1、本发明公开的一种商品车转运机器人多传感器目标对接系统,集检测、识别、定位、导航、控制于一体,通过商品车定位定向模块远距离识别商品车车身,对商品车定位定向,确定最终取车路径;机身内部对接模块近距离扫描商品车轮胎,获取机器人空腔内部距商品车两边的距离,传递给机器人控制与通信模块,转化为纠偏控制量,实现对机器人运动纠偏;当对接之后,机器人控制与通信模块控制装夹模块抱夹商品车轮胎,该方法实现商品车转运机器人主动搜索商品车并完成自主取车、自主搬运,提高商品车转运机器人的转运效率。1. The invention discloses a multi-sensor target docking system for a commercial vehicle transfer robot, which integrates detection, identification, positioning, navigation, and control. It uses the commercial vehicle positioning and orientation module to remotely identify the commercial vehicle body and position and orient the commercial vehicle. Determine the final pick-up path; the internal docking module of the fuselage scans the tires of the commercial vehicle at close range, obtains the distance between the inside of the robot cavity and both sides of the commercial vehicle, and passes it to the robot control and communication module to convert it into a correction control quantity to realize the correction of the robot's motion; After docking, the robot control and communication module controls the clamping module to clamp the commercial vehicle tires. This method enables the commercial vehicle transfer robot to actively search for the commercial vehicle and complete autonomous pickup and autonomous transportation, thereby improving the transfer efficiency of the commercial vehicle transfer robot.
3、本发明公开的一种商品车转运机器人多传感器目标对接系统,采用的商品车定位定向模块包括32线激光雷达、可见光摄像机、红外摄像机和三维伺服转台,三维伺服转台包含两个垂直安装的电机,可以实现三维方向运动,通过将32线激光雷达、可见光摄像机、红外摄像机安装在三维伺服转台上,实现了多范围环境检测,同时融合了多线激光雷达、可见光信息、红外摄像头多传感器信息获得商品车的位姿信息,采集的信息丰富,实现了商品车转运机器人对商品车无数据通讯下的高精度定位。3. The invention discloses a multi-sensor target docking system for a commercial vehicle transfer robot. The commercial vehicle positioning and orientation module used includes a 32-line laser radar, a visible light camera, an infrared camera and a three-dimensional servo turntable. The three-dimensional servo turntable includes two vertically installed The motor can realize three-dimensional directional movement. By installing the 32-line lidar, visible light camera, and infrared camera on the three-dimensional servo turntable, multi-range environmental detection is achieved, and the multi-line lidar, visible light information, and infrared camera multi-sensor information are simultaneously integrated. The position and orientation information of the commercial vehicle is obtained, and the collected information is rich, achieving high-precision positioning of the commercial vehicle by the commercial vehicle transfer robot without data communication.
4、本发明公开的一种商品车转运机器人多传感器目标对接系统,采用的机身内部纠偏模块安装在商品车转运机器人车架空腔内部,当商品车出现在商品车转运机器人空腔内部时,机身内部纠偏模块近距离检测商品车轮胎,在商品车转运机器人对接过程中,通过获取商品车转运机器人空腔两边与商品车轮胎两边的距离,实现对商品车转运机器人的对接运动纠偏;通过检测内部纠偏模块前部单线激光雷达是否对齐商品车前部车轮,实现对商品车转运机器人停车精准控制;通过检测内部纠偏模块后部的单线激光雷达是否对齐商品车后部车轮,实现对商品车转运机器人装夹模块轴距调整精准控制。4. The invention discloses a multi-sensor target docking system for a commercial vehicle transfer robot. The internal deviation correction module used in the fuselage is installed inside the cavity of the frame of the commercial vehicle transfer robot. When the commercial vehicle appears inside the cavity of the commercial vehicle transfer robot, The correction module inside the fuselage detects the commercial vehicle tires at close range. During the docking process of the commercial vehicle transfer robot, the distance between the two sides of the cavity of the commercial vehicle transfer robot and the two sides of the commercial vehicle tires is obtained to achieve the correction of the docking movement of the commercial vehicle transfer robot; through Detect whether the single-line lidar at the front of the internal correction module is aligned with the front wheels of the commercial vehicle to achieve precise parking control of the commercial vehicle transfer robot; by detecting whether the single-line lidar at the rear of the internal correction module is aligned with the rear wheels of the commercial vehicle, it is possible to accurately control the parking of the commercial vehicle. The wheelbase adjustment of the transfer robot's clamping module is precisely controlled.
5、本发明公开的一种商品车转运机器人多传感器目标对接系统,采用的装夹模块包含升降机构、轴距调整机构和夹爪摆动机构,可以实现升降动作、轴距调整动作、夹爪摆动动作,升降工作实现了将商品车抬起、放下,轴距调整动作实现了商品车转运机器人可以搬运不同尺寸的商品车,夹爪摆动动作实现了通过夹爪夹取、松开商品车轮胎,进而稳定地完成取车和放车作业,夹爪的一边安装红外传感器,通过机器人控制与通信模块检测红外传感器是否触发,检测装夹模块的夹爪是否加紧商品车轮胎,保证了商品车装运机器人的取车安全性。5. The invention discloses a multi-sensor target docking system for a commercial vehicle transfer robot. The clamping module used includes a lifting mechanism, a wheelbase adjustment mechanism and a clamping claw swing mechanism, which can realize lifting actions, wheelbase adjustment actions, and clamping claw swinging. The movement and lifting work realize the lifting and lowering of the commercial vehicle. The wheelbase adjustment action realizes the commodity vehicle transfer robot to transport commercial vehicles of different sizes. The swing action of the clamping claw realizes the clamping and loosening of the tires of the commercial vehicle. Then the car picking and placing operations are completed stably. An infrared sensor is installed on one side of the clamping claw. The robot control and communication module detects whether the infrared sensor is triggered, and detects whether the clamping claw of the clamping module tightens the commercial vehicle tires, ensuring that the commercial vehicle shipping robot The safety of picking up the car.
6、本发明公开的一种商品车转运机器人多传感器目标对接系统,采用的四周障碍物检测模块由安装在商品车转运机器人四周的四个多线激光雷达组成,能无死角检测周围所有障碍物信息,并获取商品车转运机器人距离障碍物的距离。6. The invention discloses a multi-sensor target docking system for a commercial vehicle transfer robot. The surrounding obstacle detection module used is composed of four multi-line laser radars installed around the commercial vehicle transfer robot. It can detect all surrounding obstacles without blind spots. information and obtain the distance between the commercial vehicle transfer robot and the obstacle.
附图说明Description of the drawings
图1为本发明的商品车转运机器人及其结构;Figure 1 shows the commercial vehicle transfer robot and its structure of the present invention;
图2为本发明的商品车转运机器人的侧视图;Figure 2 is a side view of the commercial vehicle transfer robot of the present invention;
图3为本发明的商品车转运机器人的正视图;Figure 3 is a front view of the commercial vehicle transfer robot of the present invention;
图4为本发明的商品车转运机器人的俯视图;Figure 4 is a top view of the commercial vehicle transfer robot of the present invention;
图5为本发明的商品车定位定向模块的结构图;Figure 5 is a structural diagram of the commercial vehicle positioning and orientation module of the present invention;
图6为本发明的四周障碍物检测模块、机身内部纠偏模块、商品车定位定向模块的安装位置;Figure 6 shows the installation positions of the surrounding obstacle detection module, the fuselage internal deviation correction module, and the commercial vehicle positioning and orientation module of the present invention;
图7为本发明的商品车自主转运机器人的信息流传输过程。Figure 7 shows the information flow transmission process of the commercial vehicle autonomous transfer robot of the present invention.
其中,1—商品车转运机器人车架、2—商品车定位定向模块、3—机身内部纠偏模块、4—四周障碍物检测模块、5—装夹模块、6—控制与通信模块、7—组合导航模块、8—32线激光雷达、9—红外摄像机、10—可见光摄像机、11—毫米波雷达、12—伺服电机、13—三维伺服转台底座。Among them, 1-commercial vehicle transfer robot frame, 2-commercial vehicle positioning and orientation module, 3-body internal deviation correction module, 4-surrounding obstacle detection module, 5-clamping module, 6-control and communication module, 7- Integrated navigation module, 8-32-line laser radar, 9-infrared camera, 10-visible light camera, 11-millimeter wave radar, 12-servo motor, 13-three-dimensional servo turntable base.
具体实施方式Detailed ways
下面将结合附图和实施例对本发明加以详细说明。同时也叙述了本发明技术方案解决的技术问题及有益效果,需要指出的是,所描述的实施例仅旨在便于对本发明的理解,而对其他不起任何限定作用。The present invention will be described in detail below with reference to the drawings and embodiments. At the same time, the technical problems and beneficial effects solved by the technical solution of the present invention are also described. It should be pointed out that the described embodiments are only intended to facilitate the understanding of the present invention and do not have any limiting effect on others.
本实施例公开的一种商品车转运机器人多传感器目标对接系统安装在一种商品车转运机器人上,实现了商品车转运机器人精准对接并搬运商品车,实现汽车码头的低碳化、智能化,提高了汽车码头的工作效率。商品车转运机器人中间为空腔,用于承载商品车,商品车转运机器人长6m,宽3m,高2.8m,重5.9t。如图1商品车转运机器人的机构组成、图2商品车转运机器人侧视图的机构组成、图3商品车转运机器人正视图的结构组成、图4商品车转运机器人俯视图的机构组成所示,商品车转运机器人多传感器目标对接系统由商品车转运机器人车架1、商品车定位定向模块2、机身内部纠偏模块3、四周障碍物检测模块4、装夹模块5、控制与通信模块6、组合导航模块7七大部分组成。The multi-sensor target docking system of a commercial vehicle transfer robot disclosed in this embodiment is installed on a commercial vehicle transfer robot, which enables the commercial vehicle transfer robot to accurately dock and transport commercial vehicles, realize low-carbonization and intelligence of the automobile terminal, and improve Improve the working efficiency of the car terminal. There is a cavity in the middle of the commercial vehicle transfer robot, which is used to carry the commercial vehicle. The commercial vehicle transfer robot is 6m long, 3m wide, 2.8m high and weighs 5.9t. As shown in Figure 1, the structural composition of the commercial vehicle transfer robot, Figure 2, the structural composition of the side view of the commercial vehicle transfer robot, Figure 3, the structural composition of the front view of the commercial vehicle transfer robot, and Figure 4, the structural composition of the top view of the commercial vehicle transfer robot, the commercial vehicle The multi-sensor target docking system of the transfer robot consists of the commercial vehicle transfer robot frame 1, the commercial vehicle positioning and orientation module 2, the internal deviation correction module 3 of the fuselage, the surrounding obstacle detection module 4, the clamping module 5, the control and communication module 6, and the integrated navigation Module 7 consists of seven parts.
所述商品车转运机器人车架1由钢筋搭建而成,中间设置了空腔,用于承载商品车,车架长6m,宽3m,高2.8m,空腔内部长6m,宽2.2m,高2.5m,商品车转运机器人与商品车对接时,商品车会逐渐存在于商品车转运机器人车架1空腔内部,商品车定位定向模块2、机身内部纠偏模块3、四周障碍物检测模块4、装夹模块5、控制与通信模块6、组合导航模块7均安装在商品车转运机器人车架1上。The commercial vehicle transfer robot frame 1 is made of steel bars with a cavity in the middle for carrying commercial vehicles. The frame is 6m long, 3m wide and 2.8m high. The interior of the cavity is 6m long, 2.2m wide and 2.2m high. 2.5m, when the commercial vehicle transfer robot is docked with the commercial vehicle, the commercial vehicle will gradually exist inside the cavity of the commercial vehicle transfer robot frame 1, the commercial vehicle positioning and orientation module 2, the internal deviation correction module 3 of the fuselage, and the surrounding obstacle detection module 4 , clamping module 5, control and communication module 6, and integrated navigation module 7 are all installed on the frame 1 of the commercial vehicle transfer robot.
所述商品车定位定向模块2如图5所示,该模块高为317.5mm,长为270mm,宽为165mm,由32线激光雷达8、红外摄像机9、可见光摄像机10、两个伺服电机12、三维伺服转台底座13组成,商品车定位定向模块2安装在商品车转运机器人车架1顶部前方位置。三维伺服转台有两个伺服电机12组成,实现三维伺服转台多角度自由运动。其中,32线激光雷达8安装在三维伺服转台底座13顶部中间位置,红外摄像机9和可见光摄像机10安装在32线激光雷达8的两侧,为了使得商品车转运机器人可以大范围扫描前方距离,又提高扫描效率,三维伺服转台的运动俯仰角度设置为-60度到0度,方位角度设置为-120度到120度,实现了对商品车转运机器人前方位置的全方位检测。The commercial vehicle positioning and orientation module 2 is shown in Figure 5. The module is 317.5mm high, 270mm long, and 165mm wide. It consists of a 32-line laser radar 8, an infrared camera 9, a visible light camera 10, and two servo motors 12, It consists of a three-dimensional servo turntable base 13, and the commercial vehicle positioning and orientation module 2 is installed on the top front position of the commercial vehicle transfer robot frame 1. The three-dimensional servo turntable is composed of two servo motors 12 to realize multi-angle free movement of the three-dimensional servo turntable. Among them, the 32-line lidar 8 is installed at the middle position of the top of the three-dimensional servo turntable base 13, and the infrared camera 9 and the visible light camera 10 are installed on both sides of the 32-line lidar 8. In order to enable the commercial vehicle transfer robot to scan the distance ahead in a wide range, To improve scanning efficiency, the motion pitch angle of the three-dimensional servo turntable is set to -60 degrees to 0 degrees, and the azimuth angle is set to -120 degrees to 120 degrees, achieving all-round detection of the front position of the commercial vehicle transfer robot.
所述机身内部纠偏模块3的安装位置如图6所示,该模块由四个安装在商品车转运机器人机身内部装夹模块5的夹爪中间位置的单线激光雷达组成,用于扫描商品车轮胎,对商品车轮胎进行定位定向。每个单线激光雷达都朝下,其中,前部单线激光雷达随着机器人前部的装夹模块5只能上下移动,用于商品车前轮的定位定向。在对接过程中,当商品车处于商品车转运机器人空腔内部时,单线激光雷达扫描商品车轮胎,控制与通信模块6检测机器人空腔内部两边与商品车轮胎的距离,并转化为纠偏控制量,控制机器人纠偏;当前部单线激光雷达识别到商品车前部轮胎的中央位置时,机器人控制与通信模块6控制商品车转运机器人停止运动;后部单线激光雷达既可以随着机器人后部的装夹模块5上下运动,又可以随着机器人后部的装夹模块5前后运动,用于商品车后轮的定位定向,通过机身内部纠偏模块3后部单线激光雷达检测是否与商品车后部车轮对齐,从而判断装夹模块5是否需要调整轴距,实现装夹模块5可以稳定抱夹商品车轮胎。The installation position of the correction module 3 inside the fuselage is shown in Figure 6. This module consists of four single-line laser radars installed in the middle of the clamping jaws of the clamping module 5 inside the fuselage of the commercial vehicle transfer robot for scanning commodities. Car tires, positioning and orienting commercial car tires. Each single-line lidar faces downward. The front single-line lidar can only move up and down along with the clamping module 5 on the front of the robot, which is used to position and orient the front wheels of commercial vehicles. During the docking process, when the commercial vehicle is inside the cavity of the commercial vehicle transfer robot, the single-line laser radar scans the tires of the commercial vehicle, and the control and communication module 6 detects the distance between both sides of the robot cavity and the tires of the commercial vehicle, and converts it into a correction control quantity. , control the robot to correct the deviation; when the front single-line lidar recognizes the center position of the front tire of the commercial vehicle, the robot control and communication module 6 controls the commercial vehicle transfer robot to stop moving; the rear single-line lidar can follow the installation of the rear part of the robot. The clamping module 5 moves up and down, and can also move forward and backward with the clamping module 5 at the rear of the robot. It is used to position and orient the rear wheels of the commercial vehicle. The single-line laser radar at the rear of the rectification module 3 inside the fuselage detects whether it is in line with the rear wheel of the commercial vehicle. The wheels are aligned to determine whether the clamping module 5 needs to adjust the wheelbase, so that the clamping module 5 can stably clamp commercial vehicle tires.
所述四周障碍物检测模块4如图6所示,主要由安装在机器人顶部前方位置的三维伺服转台底座13上的毫米波雷达11和安装在机器人机身四周位置的四个16线激光雷达组成,前后方的16线激光雷达的距离为6m,左右两侧的16线激光雷达间距为3m,毫米波雷达11从机器人顶部位置检测机器人前方远距离方向的障碍物信息,机器人机身四周四个16线激光雷达无死区检测机器人周围的障碍物信息,并将障碍物信息其传到控制与通信模块6的控制箱中,控制机器人停止运动或规划局部路径躲避障碍物。The surrounding obstacle detection module 4 is shown in Figure 6 and mainly consists of a millimeter wave radar 11 installed on a three-dimensional servo turntable base 13 in front of the top of the robot and four 16-line laser radars installed around the robot body. , the distance between the 16-line lidar at the front and rear is 6m, and the distance between the 16-line lidar at the left and right sides is 3m. The millimeter-wave radar 11 detects obstacle information in the long-distance direction in front of the robot from the top position of the robot. Four corners around the robot body The 16-line laser radar detects obstacle information around the robot without dead zones, and transmits the obstacle information to the control box of the control and communication module 6 to control the robot to stop moving or plan a local path to avoid obstacles.
所述装夹模块5安装在商品车转运机器人空腔内部左前、右前、左后、右后四个位置,包括升降机构、轴距调整机构、夹爪摆动机构。升降机构由伺服电机、蜗轮蜗杆减速机、滚装丝杠、导轨模块组成,实现升降动作,其中伺服电机功率为3KW,额定输出转速为1500rpm,额定输出扭矩19.7Nm,蜗轮蜗杆减速箱速比28,滚珠丝杠导程10mm;轴距调整机构由伺服电机、行星减速机、滚珠丝杠、导轨滑块组成,实现轴距调整动作,其中伺服电机功率为1KW,额定输出转速为1500rpm,减速机速比5,滚珠丝杠导程20mm;夹爪摆动机构由伺服电机、行星减速机、正反旋梯形丝杠、滑块摇杆机构组成,实现夹爪摆动动作,夹爪的一边安装了红外传感器,通过检测红外传感器是否触发,可以检测夹爪是否夹紧商品车轮胎。The clamping module 5 is installed at four positions including the left front, right front, left rear, and right rear inside the cavity of the commercial vehicle transfer robot, and includes a lifting mechanism, a wheelbase adjustment mechanism, and a clamping jaw swing mechanism. The lifting mechanism is composed of a servo motor, a worm gear reducer, a rolling screw, and a guide rail module to realize the lifting action. The servo motor power is 3KW, the rated output speed is 1500rpm, the rated output torque is 19.7Nm, and the worm gearbox speed ratio is 28 , the ball screw lead is 10mm; the wheelbase adjustment mechanism is composed of a servo motor, a planetary reducer, a ball screw, and a guide rail slider to realize the wheelbase adjustment action. The servo motor power is 1KW, the rated output speed is 1500rpm, and the reducer The speed ratio is 5, the ball screw lead is 20mm; the clamping jaw swing mechanism is composed of a servo motor, a planetary reducer, a forward and reverse rotating trapezoidal screw, and a slider rocker mechanism to realize the swinging action of the clamping jaw. An infrared sensor is installed on one side of the clamping jaw. Sensor, by detecting whether the infrared sensor is triggered, it can detect whether the clamping jaw is clamping the commercial vehicle tire.
所述控制与通信模块6安装在商品车转运机器人车架1内部,主要由机器人控制箱、5G路由器、交换机组成,机器人控制箱接受商品车转运机器人商品车定位定向模块、机身内部纠偏模块、四周障碍物检测模块、装夹模块的传感器感知信息,获取控制策略;5G路由器实现与云端调度系统、码头操作系统通讯。The control and communication module 6 is installed inside the commercial vehicle transfer robot frame 1 and is mainly composed of a robot control box, a 5G router, and a switch. The robot control box accepts the commercial vehicle transfer robot's commercial vehicle positioning and orientation module, the internal deviation correction module of the fuselage, The sensors of the surrounding obstacle detection module and clamping module sense information and obtain the control strategy; the 5G router implements communication with the cloud dispatch system and the terminal operating system.
所述组合导航模块7主要包含GPS定位系统和姿态传感器,GPS定位系统的位置天线安装在商品车转运机器人车架1上的顶部中间位置,方向天线安装在商品车转运机器人车架1上的顶部靠前位置,姿态传感器安装在机器人控制箱里,实现机器人的定位定向。The integrated navigation module 7 mainly includes a GPS positioning system and an attitude sensor. The position antenna of the GPS positioning system is installed at the top middle position of the commercial vehicle transfer robot frame 1, and the direction antenna is installed at the top of the commercial vehicle transfer robot frame 1. At the front position, the attitude sensor is installed in the robot control box to realize the positioning and orientation of the robot.
如图7所示,商品车定位定向模块2中的32线激光雷达8、红外摄像机9、可见光摄像机10通过UDP方式与控制与通信模块6中的控制箱通信,商品车定位定向模块2中的三维伺服转台的两个伺服电机12利用ROS控制,通过CAN通信的方式与控制与通信模块6中的控制箱通信;机身内部纠偏模块3的四个单线激光雷达利用ROS控制,通过UDP方式与控制与通信模块6中的控制箱通信;四周障碍物检测模块4中的4个16线激光雷达和毫米波传感器11通过UDP方式与控制与通信模块6中的控制箱通信;组合导航模块7中的GPS定位系统和姿态传感器利用ROS控制,通过串口通信方式与控制与通信模块6的控制箱通信。As shown in Figure 7, the 32-line lidar 8, infrared camera 9, and visible light camera 10 in the commercial vehicle positioning and orientation module 2 communicate with the control box in the control and communication module 6 through UDP. The two servo motors 12 of the three-dimensional servo turntable are controlled by ROS and communicate with the control box in the control and communication module 6 through CAN communication; the four single-line laser radars of the correction module 3 inside the fuselage are controlled by ROS and communicate with the control box through UDP. The control box in the control and communication module 6 communicates; the four 16-line lidar and millimeter wave sensors 11 in the surrounding obstacle detection module 4 communicate with the control box in the control and communication module 6 through UDP; the integrated navigation module 7 The GPS positioning system and attitude sensor are controlled by ROS and communicate with the control box of the control and communication module 6 through serial communication.
商品车转运机器人通过控制与通信模块6,利用自主导航技术到达商品车前位置,四周障碍物检测模块4时刻检测机器人周围环境障碍物信息,机器人利用商品车定位定向模块2远距离扫描商品车车身,并将车身的点云数据传递给机器人控制与通信模块6,实现机器人对商品车的远距离定位定向,机器人控制与通信模块6动态规划对接路径,利用轨迹跟踪算法控制商品车转运机器人运动,当商品车处于商品车转运机器人内部空腔时,机身内部纠偏模块3近距离检测商品车轮胎,并将轮胎点云信息传递控制与通信模块6,实现对商品车轮胎的定位定向和近距离纠偏控制,控制与通信模块6控制商品车转运机器人的装夹模块5对准商品车轮胎,进而控制装夹模块5抱夹商品车轮胎,并抬起商品车,完成商品车转运机器人取车动作;之后,控制与通信模块6控制商品车转运机器人通过自主导航技术,将商品车转运到指定位置;控制与通信模块6控制装夹模块5同时下降,夹爪放下商品车轮胎,完成商品车转运机器人放车动作。The commercial vehicle transfer robot uses autonomous navigation technology to reach the position in front of the commercial vehicle through the control and communication module 6. The surrounding obstacle detection module 4 detects obstacle information in the surrounding environment of the robot at all times. The robot uses the commercial vehicle positioning and orientation module 2 to scan the commercial vehicle body from a long distance. , and transfers the point cloud data of the car body to the robot control and communication module 6 to realize the long-distance positioning and orientation of the commercial vehicle by the robot. The robot control and communication module 6 dynamically plans the docking path, and uses the trajectory tracking algorithm to control the movement of the commercial vehicle transfer robot. When the commercial vehicle is in the internal cavity of the commercial vehicle transfer robot, the deviation correction module 3 inside the fuselage detects the commercial vehicle tires at close range, and transmits the tire point cloud information to the control and communication module 6 to realize the positioning and orientation of the commercial vehicle tires at close range. Correction control, control and communication module 6 controls the clamping module 5 of the commercial vehicle transfer robot to align the commercial vehicle tires, and then controls the clamping module 5 to hold and clamp the commercial vehicle tires, and lift the commercial vehicle to complete the pickup action of the commercial vehicle transfer robot. ; After that, the control and communication module 6 controls the commercial vehicle transfer robot to transfer the commercial vehicle to the designated location through autonomous navigation technology; the control and communication module 6 controls the clamping module 5 to descend at the same time, and the clamping claws put down the tires of the commercial vehicle to complete the transfer of the commercial vehicle. The robot releases the car.
综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。To sum up, the above are only preferred embodiments of the present invention and are not intended to limit the scope of the present invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention shall be included in the protection scope of the present invention.
Claims (6)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311431503.XA CN117434949A (en) | 2023-10-31 | 2023-10-31 | A multi-sensor target docking system for commercial vehicle transfer robots |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311431503.XA CN117434949A (en) | 2023-10-31 | 2023-10-31 | A multi-sensor target docking system for commercial vehicle transfer robots |
Publications (1)
Publication Number | Publication Date |
---|---|
CN117434949A true CN117434949A (en) | 2024-01-23 |
Family
ID=89554919
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202311431503.XA Pending CN117434949A (en) | 2023-10-31 | 2023-10-31 | A multi-sensor target docking system for commercial vehicle transfer robots |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN117434949A (en) |
-
2023
- 2023-10-31 CN CN202311431503.XA patent/CN117434949A/en active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109160452B (en) | Unmanned transfer forklift based on laser positioning and stereoscopic vision and navigation method | |
CN105607635B (en) | Panoramic optical vision navigation control system of automatic guided vehicle and omnidirectional automatic guided vehicle | |
US10612261B2 (en) | AGV comb-type transfer robot | |
CN111158355A (en) | Automatic navigation cloud server and automatic navigation control method | |
CN110045739A (en) | A kind of intelligent storage material robot, control system and control method | |
CN206128772U (en) | Intelligent automobile transfer robot based on UWB location | |
CN102608998A (en) | Vision guiding AGV (Automatic Guided Vehicle) system and method of embedded system | |
CN104089623A (en) | System and method for generating driving state and path of transportation vehicle | |
CN112093467A (en) | A mobile handling robot system and its control method | |
CN116620802B (en) | Transportation method utilizing indoor construction intelligent material transportation system | |
CN113463719B (en) | Autonomous operation control system and method for loader | |
CN111930125A (en) | Low-cost obstacle detection device and method suitable for AGV | |
CN112477533B (en) | Dual-purpose transport robot of facility agriculture rail | |
CN213594408U (en) | An intelligent guided vehicle for warehousing and logistics | |
CN107943026B (en) | Mecanum wheel patrol robot and its patrol method | |
CN113218384A (en) | Indoor AGV self-adaptation positioning system based on laser SLAM | |
CN209024143U (en) | A kind of unmanned transhipment fork truck based on laser positioning and stereoscopic vision | |
CN217496560U (en) | Intelligent omnidirectional airport luggage conveying and rotating platform control system | |
CN117434949A (en) | A multi-sensor target docking system for commercial vehicle transfer robots | |
CN117406735A (en) | Multi-information feedback commodity vehicle transfer AGV autonomous transport control method | |
CN211061900U (en) | Autonomous navigation logistics robot control system | |
CN115097504B (en) | Multi-sensor fusion perception unmanned patrol car system and working method | |
CN117389273A (en) | Automatic operation system of AGV is transported to commodity car | |
Yang et al. | A human-like dual-forklift collaborative mechanism for container handling | |
CN211478964U (en) | Obstacle avoidance system for intelligent transportation device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |