WO2024044975A1 - Control method and apparatus for mobile robotic arm - Google Patents

Control method and apparatus for mobile robotic arm Download PDF

Info

Publication number
WO2024044975A1
WO2024044975A1 PCT/CN2022/115904 CN2022115904W WO2024044975A1 WO 2024044975 A1 WO2024044975 A1 WO 2024044975A1 CN 2022115904 W CN2022115904 W CN 2022115904W WO 2024044975 A1 WO2024044975 A1 WO 2024044975A1
Authority
WO
WIPO (PCT)
Prior art keywords
signal
mobile
movement signal
arm
controller
Prior art date
Application number
PCT/CN2022/115904
Other languages
French (fr)
Chinese (zh)
Inventor
陈斌
王子健
范顺杰
Original Assignee
西门子股份公司
西门子(中国)有限公司
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 西门子股份公司, 西门子(中国)有限公司 filed Critical 西门子股份公司
Priority to PCT/CN2022/115904 priority Critical patent/WO2024044975A1/en
Publication of WO2024044975A1 publication Critical patent/WO2024044975A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00Manipulators mounted on wheels or on carriages
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls

Definitions

  • the present invention mainly relates to the field of mechanical automation, and in particular, to a control method and device for moving a robotic arm.
  • Mobile robotic arms are widely used in the manufacturing industry and are mainly used to process workpieces in an agile manner. Typical application scenarios include moving workpieces.
  • Mobile robotic arms usually include a mobile chassis and an arm body.
  • the mobile chassis and arm body are controlled by two controllers respectively.
  • the mobile chassis When the arm body is working, the mobile chassis must stop and hold, or conversely, when the mobile chassis moves, the arm body must stop. And keep it.
  • the vibration generated by the movement of the mobile chassis will cause the arm to shake, making it impossible to pick up or process the workpiece stably and accurately.
  • Another reason is that the accuracy of the mobile chassis is far less than that of the arm. For this reason, the arm The body must be stopped and repositioned every time before processing the workpiece.
  • the present invention provides a control method and device for a mobile robotic arm to compensate for errors caused by the movement of the mobile chassis.
  • the mobile chassis and the arm body can move accurately at the same time, improving the working efficiency of the mobile robotic arm and expanding the Application scenarios of mobile robotic arms.
  • the present invention proposes a control method for a mobile robotic arm.
  • the mobile robotic arm includes a mobile chassis and an arm body installed on the mobile chassis.
  • the mobile chassis is provided with an inertia measurement unit and a measurement unit.
  • a distance meter, a camera is provided on the arm, and the method includes: acquiring the movement signal of the mobile chassis provided by the inertial measurement unit, and parsing the first movement signal of the mobile chassis based on the movement signal.
  • fusing the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis includes: converting the first movement signal and the second movement signal into the same coordinate system, The first movement signal is corrected using the second movement signal as a reference in the same coordinate system to obtain a composite movement signal of the mobile chassis. To this end, by fusing the first movement signal and the second movement signal, a more accurate movement signal of the mobile chassis can be obtained.
  • the synthetic movement signal and the image collected by the camera before performing path planning on the mobile manipulator according to the vibration signal, the synthetic movement signal and the image collected by the camera, it further includes: coordinating the vibration signal, the synthetic movement signal and the camera The sampling rate of the collected images.
  • the efficiency of signal processing can be improved, thereby improving the working efficiency of the mobile robotic arm.
  • the mobile manipulator further includes a first controller and a second controller
  • the method includes: in the first controller based on the vibration signal, the synthesized movement signal and the image information collected by the camera A path is planned for the mobile robotic arm, and the second controller controls the arm body according to the result of the path planning.
  • the invention also proposes a control device for a mobile robotic arm.
  • the mobile robotic arm includes a mobile chassis and an arm body installed on the mobile chassis.
  • the mobile chassis is provided with an inertial measurement unit and a rangefinder.
  • a camera is provided on the arm, and the device includes: a first acquisition module that acquires the motion signal of the mobile chassis provided by the inertial measurement unit, and analyzes the first movement of the mobile chassis based on the motion signal.
  • the second acquisition module acquires the second movement signal sensed by the rangefinder, and fuses the first movement signal and the second movement signal to obtain a synthetic movement signal of the mobile chassis;
  • control A module that performs path planning on the mobile robotic arm according to the vibration signal, the synthetic movement signal and the image collected by the camera, and controls the arm body according to the result of path planning.
  • the second acquisition module fuses the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis including: combining the first movement signal and the second movement signal Convert to the same coordinate system, and correct the first movement signal based on the second movement signal in the same coordinate system to obtain a composite movement signal of the mobile chassis.
  • control module before the control module performs path planning for the mobile manipulator based on the vibration signal, the synthetic movement signal and the image collected by the camera, it further includes: coordinating the vibration signal, the synthetic movement signal and the sampling rate of images collected by the camera.
  • the mobile manipulator further includes a first controller and a second controller
  • the device includes: in the first controller based on the vibration signal, the synthesized movement signal and the camera collected
  • the image information is used to plan a path for the mobile robotic arm, and the second controller controls the arm body according to the result of the path planning.
  • the invention also proposes a mobile mechanical arm.
  • the mobile mechanical arm includes a mobile chassis and an arm body installed on the mobile chassis.
  • the mobile chassis is provided with an inertial measurement unit and a rangefinder.
  • the arm body A camera is provided on the mobile manipulator, and the mobile manipulator also includes a controller configured to: obtain the motion signal of the mobile chassis provided by the inertial measurement unit, and analyze the mobile chassis based on the motion signal.
  • the first movement signal and vibration signal obtain the second movement signal sensed by the rangefinder, and fuse the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis; according to the
  • the vibration signal, the synthetic movement signal and the image collected by the camera perform path planning on the mobile robotic arm, and the arm body is controlled according to the result of path planning.
  • the controller includes a first controller and a second controller.
  • the first controller controls the mobile manipulator according to the vibration signal, the synthesized movement signal and the image information collected by the camera.
  • Perform path planning and the second controller controls the arm body according to the result of path planning.
  • the present invention also proposes an electronic device, including a processor, a memory and instructions stored in the memory, wherein when the instructions are executed by the processor, the above method is implemented.
  • the present invention also proposes a computer-readable storage medium on which computer instructions are stored, which execute the method as described above when executed.
  • the present invention also proposes a computer program product, which is characterized in that it includes a computer program that implements the above method when executed by a processor.
  • Figure 1 is a flow chart of a control method for a mobile robotic arm according to an embodiment of the present invention
  • Figure 2 is a schematic diagram of an application scenario of a mobile robotic arm according to an embodiment of the present invention
  • Figure 3 is a functional block diagram of a mobile robotic arm according to an embodiment of the present invention.
  • Figure 4 is a schematic diagram of a control device for a mobile robotic arm according to an embodiment of the present invention.
  • Figure 5 is a schematic diagram of an electronic device according to an embodiment of the present invention.
  • FIG 2 is a schematic diagram of an application scenario of a mobile robotic arm according to an embodiment of the present invention.
  • the application scenario includes a mobile robotic arm 21 and a workpiece 22.
  • the mobile robotic arm 21 includes a mobile chassis 201 and an arm.
  • the body 202 is provided with a walking unit 207 under the mobile chassis 201 so that the mobile robot arm 21 can move.
  • a rangefinder 206 (not shown) is also provided on the mobile chassis 201 for measuring the displacement of the mobile chassis 201.
  • the rangefinder 206 may be an odometer or a laser radar.
  • the mobile chassis 201 is provided with an inertial measurement unit 203 for sensing the acceleration signal and angular velocity signal of the mobile chassis 201 .
  • the arm body 202 is installed on the mobile chassis 201.
  • a typical arm body 202 can have six degrees of freedom to flexibly grasp the workpiece 22.
  • a camera 204 is installed on the arm body 202. The camera 204 can collect environmental images for environmental perception and processing.
  • the target workpiece is identified from the environment image, and an expandable clamp 208 is provided at the end of the arm body 202 to clamp and lower the workpiece 22 .
  • FIG. 1 is a flow chart of a control method 100 for a mobile robotic arm according to an embodiment of the present invention. The following is a combination of Figures 1 and 2 in the embodiment of the present invention. The control method of the mobile robot arm is explained. As shown in Figure 1, the method 100 includes:
  • Step 110 Obtain the motion signal of the mobile chassis provided by the inertial measurement unit, and analyze the first motion signal and vibration signal of the mobile chassis based on the motion signal.
  • the inertial measurement unit is a combination of a gyroscope and an accelerometer.
  • the gyroscope is used to sense the three-axis angular velocity signal of the mobile chassis 201
  • the accelerometer is used to sense the three-axis acceleration signal of the mobile chassis. These two can be used.
  • the third signal calculates the motion signal of the mobile chassis through the attitude fusion algorithm, and separates the first motion signal and the vibration signal in the motion signal through frequency characteristics.
  • the first motion signal can be the displacement value and speed value of the mobile chassis in time series
  • the vibration signal may be a time series of vibration amplitude and speed values of the moving chassis.
  • FIG 3 is a functional block diagram of a mobile robotic arm according to an embodiment of the present invention.
  • the inertial measurement unit 203 senses the three-axis angular velocity signal and the three-axis acceleration signal of the mobile chassis.
  • the axis angular velocity signal and the three-axis acceleration signal are calculated as motion signals through the posture fusion algorithm.
  • the motion signals are sent to the separation unit 205a in the controller 205.
  • the separation unit 205a separates the first movement signal and vibration of the mobile chassis 201 through frequency characteristics. signals, where the first movement signal is sent to the fusion module 205b and the vibration signal is sent to the sampling coordination unit 205d.
  • Step 120 Obtain the second movement signal sensed by the rangefinder, and fuse the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis.
  • the rangefinder 206 may be an odometer and/or a lidar, and is used to sense the second movement signal of the mobile chassis 201.
  • the second movement signal is sent to the fusion unit 205b of the controller 205, and the fusion unit 205b fuses the rangefinder.
  • fusing the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis includes: converting the first movement signal and the second movement signal into the same coordinate system, and using the second movement signal in the same coordinate system.
  • the movement signal is used as a reference to correct the first movement signal to obtain a composite movement signal of the mobile chassis.
  • lidar as a rangefinder as an example
  • the second moving signal sensed by lidar is more accurate and the signal points are scattered, but the measured distance is relative to the feature points.
  • the first moving signal obtained by the inertial measurement unit is more accurate. Slightly worse, the signal points are dense, but the measurement distance is relative to the mobile chassis itself.
  • the first mobile signal and the second mobile signal are transformed into the same coordinate system.
  • the sampling points of the first mobile signal are relatively dense, and the sampling points of the second mobile signal are relatively discrete.
  • Weighting calculation is performed on the first mobile signal and the second mobile signal, thereby realizing the fusion of the first mobile signal and the second mobile signal.
  • Step 130 Plan the path of the mobile robotic arm based on the vibration signal, the synthetic movement signal and the image collected by the camera, and control the arm body according to the result of the path planning.
  • the camera 204 collects environmental images in real time, and the environmental images are sent to the image processing unit 205c.
  • the image processing unit 205c performs filtering, noise reduction, target recognition and other processing on the environmental images.
  • the path planning unit 205e acquires the vibration signal separated by the separation unit 205a, the synthetic movement signal provided by the fusion unit 205b, and the image signal processed by the image processing unit 205c, calculates the vibration information, movement information and image information, and uses a path planning algorithm according to the vibration information, Mobile information and image information collected by the camera are used to plan the path of the mobile robotic arm.
  • the path planning algorithm can be PRM path planning algorithm (random road map algorithm) or RRT algorithm (rapidly expanding random tree algorithm), etc., and then the arm is planned according to the planned path. For this reason, by sensing the vibration and movement of the mobile chassis, the vibration and movement of the mobile chassis can be compensated when the arm moves.
  • the arm can perform tasks stably without stopping the mobile chassis, improving mobile machinery.
  • the working efficiency of the arm expands the application scenarios of the mobile robotic arm.
  • the controller 205 before planning the path of the mobile manipulator based on the vibration signal, the synthetic movement signal, and the image collected by the camera, it also includes: coordinating the sampling rate of the vibration signal, the synthetic movement signal, and the image collected by the camera.
  • the controller 205 also includes a sampling coordination unit 205d. Since the vibration signal, the synthetic movement signal and the image collected by the camera have different sampling rates, the sampling coordination unit 205d receives the vibration signal, the synthetic movement signal and After the image collected by the camera is coordinated, the vibration signal, the synthesized movement signal and the sampling rate of the image collected by the camera are determined, that is, the frequency and timing of sending these signals to the path planning unit 205e are determined. To this end, the efficiency of signal processing can be improved, thereby improving mobile The efficiency of the robotic arm.
  • the mobile robotic arm further includes a first controller and a second controller
  • the method includes: performing path planning on the mobile robotic arm in the first controller based on the vibration signal, the synthesized movement signal, and the image information collected by the camera, And the second controller controls the arm body according to the result of path planning.
  • the first controller is a controller used to control the mobile chassis
  • the second controller is a controller used to control the arm body, that is, the controller of the mobile chassis and the arm body itself.
  • the first controller according to the vibration signal
  • synthesize the mobile signals and the images collected by the camera to plan the path of the mobile robotic arm, and control the arm body according to the results of the path planning in the second controller.
  • An embodiment of the present invention proposes a control method for a mobile robotic arm.
  • the vibration and movement of the mobile chassis can be compensated when the arm moves.
  • the arm does not need to stop when the mobile chassis stops. It can perform tasks stably, improve the work efficiency of the mobile robotic arm, and expand the application scenarios of the mobile robotic arm.
  • the invention also proposes a control device for a mobile robotic arm.
  • the mobile robotic arm includes a mobile chassis and an arm body installed on the mobile chassis.
  • the mobile chassis is provided with an inertial measurement unit and a rangefinder, and the arm body is provided with a camera.
  • Figure 4 is a schematic diagram of a control device 400 for a mobile robot arm according to an embodiment of the present invention. As shown in Figure 4, the device 400 includes:
  • the first acquisition module 410 acquires the motion signal of the mobile chassis provided by the inertial measurement unit, and analyzes the first motion signal and vibration signal of the mobile chassis based on the motion signal;
  • the second acquisition module 420 acquires the second movement signal sensed by the rangefinder, and fuses the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis;
  • the control module 430 performs path planning on the mobile robotic arm based on the vibration signal, the synthesized movement signal, and the images collected by the camera, and controls the arm body based on the results of the path planning.
  • the second acquisition module 420 fuses the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis including: converting the first movement signal and the second movement signal to the same coordinate system, in the same coordinate system The system corrects the first movement signal based on the second movement signal to obtain a composite movement signal of the mobile chassis.
  • control module 430 before the control module 430 performs path planning on the mobile manipulator based on the vibration signal, the synthetic movement signal, and the image collected by the camera, it also includes: coordinating the sampling rate of the vibration signal, the synthetic movement signal, and the image collected by the camera.
  • the mobile manipulator further includes a first controller and a second controller.
  • the device 400 includes: the first controller performs path planning on the mobile manipulator based on the vibration signal, the synthesized movement signal, and the image information collected by the camera. , and the second controller controls the arm body according to the results of path planning.
  • the invention also proposes a mobile robotic arm 21.
  • the mobile robotic arm 21 includes a mobile chassis 201 and an arm body 202 installed on the mobile chassis 201.
  • the mobile chassis 201 is provided with an inertial measurement unit 203 and a rangefinder 206.
  • the arm body 202 is provided with a camera 204, and the mobile robot arm 21 also includes a controller 205, which is characterized in that the controller 205 is configured as:
  • the path planning of the mobile robotic arm is carried out based on the vibration signal, the synthetic movement signal and the images collected by the camera, and the arm body is controlled based on the results of the path planning.
  • the controller 205 includes a first controller and a second controller.
  • the first controller performs path planning on the mobile manipulator based on vibration signals, synthetic movement signals, and image information collected by the camera.
  • the second controller performs path planning on the mobile robot arm based on The result of path planning controls the arm body.
  • FIG. 5 is a schematic diagram of an electronic device 500 according to an embodiment of the present invention.
  • the electronic device 500 includes a processor 510 and a memory 520 .
  • the memory 520 stores instructions, and when the instructions are executed by the processor 510 , the method 100 as described above is implemented.
  • the present invention also proposes a computer-readable storage medium on which computer instructions are stored, and when executed, the computer instructions execute the method 100 as described above.
  • the present invention also proposes a computer program product, which includes a computer program that implements the method 100 as described above when executed by a processor.
  • Some aspects of the method and device of the present invention may be executed entirely by hardware, may be entirely executed by software (including firmware, resident software, microcode, etc.), or may be executed by a combination of hardware and software.
  • the above hardware or software may be referred to as “data block”, “module”, “engine”, “unit”, “component” or “system”.
  • the processor may be one or more application specific integrated circuits (ASICs), digital signal processors (DSPs), digital signal processing devices (DAPDs), programmable logic devices (PLCs), field programmable gate arrays (FPGAs), processors , controller, microcontroller, microprocessor or combination thereof.
  • ASICs application specific integrated circuits
  • DSPs digital signal processors
  • DAPDs digital signal processing devices
  • PLCs programmable logic devices
  • FPGAs field programmable gate arrays
  • processors controller, microcontroller, microprocessor or combination thereof.
  • aspects of the invention may be embodied as a computer product embodied in one or more computer-readable media, the product including computer-readable program code.
  • computer-readable media may include, but are not limited to, magnetic storage devices (e.g., hard disks, floppy disks, tapes, etc.), optical disks (e.g., compact disks (CD), digital versatile disks (DVD), ...), smart cards and flash memory devices (e.g. cards, sticks, key drives).
  • a flowchart is used here to illustrate operations performed by methods according to embodiments of the present application. It should be understood that the preceding operations are not necessarily performed in exact order. Instead, the various steps can be processed in reverse order or simultaneously. At the same time, other operations may be added to these processes, or a step or steps may be removed from these processes.

Abstract

Provided in the present invention is a control method for a mobile robotic arm. The mobile robotic arm comprises a movable chassis and an arm body mounted on the movable chassis, wherein the movable chassis is provided with an inertial measurement unit and a range finder, and the arm body is provided with a camera. The method comprises: acquiring a motion signal, which is provided by an inertial measurement unit, of a movable chassis, and parsing the motion signal to obtain a first movement signal of the movable chassis and a vibration signal of same; acquiring a second movement signal sensed by a range finder, and fusing the first movement signal and the second movement signal to obtain a synthesized movement signal of the movable chassis; and according to the vibration signal, the synthesized movement signal and an image collected by the camera, performing path planning on the mobile robotic arm, and controlling the arm body according to a path planning result.

Description

移动机械臂的控制方法及装置Control method and device for mobile robotic arm 技术领域Technical field
本发明主要涉及机械自动化领域,尤其涉及一种移动机械臂的控制方法及装置。The present invention mainly relates to the field of mechanical automation, and in particular, to a control method and device for moving a robotic arm.
背景技术Background technique
移动机械臂广泛应用于制造业中,主要用于以敏捷方式处理工件,典型的应用场景包括移动工件。移动机械臂通常包括移动底盘和臂体,移动底盘和臂体分别由两个控制器控制,当臂体工作的时候移动底盘必须停止并且保持住,或者相反,当移动底盘移动时臂体必须停止并且保持住,一个原因在于移动底盘的的移动产生的震动将会导致臂体颠动,从而无法稳定准确地拿取或处理工件,另一个原因在于移动底盘的精度远不及臂体,为此臂体每次在处理工件之前必须停止和重定位,此种情况严重地降低了移动机械臂的工作效率,限制了移动机械臂的应用场景。一种解决方案是引入机器视觉作为臂体控制器的外环反馈控制,以补偿移动底盘导致的误差,然而该方法需要降低移动机械臂的移动速度以及理想的地面状况,否则成像以及目标物体的检测效果不佳。Mobile robotic arms are widely used in the manufacturing industry and are mainly used to process workpieces in an agile manner. Typical application scenarios include moving workpieces. Mobile robotic arms usually include a mobile chassis and an arm body. The mobile chassis and arm body are controlled by two controllers respectively. When the arm body is working, the mobile chassis must stop and hold, or conversely, when the mobile chassis moves, the arm body must stop. And keep it. One reason is that the vibration generated by the movement of the mobile chassis will cause the arm to shake, making it impossible to pick up or process the workpiece stably and accurately. Another reason is that the accuracy of the mobile chassis is far less than that of the arm. For this reason, the arm The body must be stopped and repositioned every time before processing the workpiece. This situation seriously reduces the work efficiency of the mobile robotic arm and limits the application scenarios of the mobile robotic arm. One solution is to introduce machine vision as the outer loop feedback control of the arm controller to compensate for the error caused by the moving chassis. However, this method requires reducing the moving speed of the mobile manipulator and ideal ground conditions, otherwise the imaging and target object The detection effect is not good.
发明内容Contents of the invention
为了解决上述技术问题,本发明提供一种移动机械臂的控制方法及装置,以补偿移动底盘的运动导致的误差,移动底盘和臂体可以同时准确地运动,提高移动机械臂的工作效率,扩展移动机械臂的应用场景。In order to solve the above technical problems, the present invention provides a control method and device for a mobile robotic arm to compensate for errors caused by the movement of the mobile chassis. The mobile chassis and the arm body can move accurately at the same time, improving the working efficiency of the mobile robotic arm and expanding the Application scenarios of mobile robotic arms.
为实现上述目的,本发明提出了一种移动机械臂的控制方法,所述移动机械臂包括移动底盘和安装在所述移动底盘上的臂体,所述移动底盘上设有惯性测量单元和测距仪,所述臂体上设有摄像头,所述方法包括:获取所述惯性测量单元提供的所述移动底盘的运动信号,并根据所述运动信号解析出所述移动底盘的第一移动信号和震动信号;获取所述测距仪感测的第二移动信号,融合所述第一移动信号和所述第二移动信号以获得所述移动底盘的合成移动信号;根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像对所述移动机械臂进行路径规划,并根据路径规划的结果对所述臂体进行控制。为此,通过感测移动底盘的震动和移动,可以在臂体运动时补偿移动底盘的震动和移动,臂体无需在移动底盘停止住时即可稳定地执行任务,提高移动机械臂的工作效率,扩展移动机械臂的应用场景。In order to achieve the above object, the present invention proposes a control method for a mobile robotic arm. The mobile robotic arm includes a mobile chassis and an arm body installed on the mobile chassis. The mobile chassis is provided with an inertia measurement unit and a measurement unit. A distance meter, a camera is provided on the arm, and the method includes: acquiring the movement signal of the mobile chassis provided by the inertial measurement unit, and parsing the first movement signal of the mobile chassis based on the movement signal. and vibration signals; obtain the second movement signal sensed by the rangefinder, fuse the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis; according to the vibration signal, the The synthetic movement signal and the image collected by the camera are used to plan the path of the mobile robotic arm, and the arm body is controlled according to the result of path planning. For this reason, by sensing the vibration and movement of the mobile chassis, the vibration and movement of the mobile chassis can be compensated when the arm moves. The arm can stably perform tasks without stopping the mobile chassis, improving the work efficiency of the mobile robotic arm. , Expand the application scenarios of mobile robotic arms.
可选地,融合所述第一移动信号和所述第二移动信号以获得所述移动底盘的合成移动 信号包括:将所述第一移动信号和所述第二移动信号转换到同一坐标系,在所述同一坐标系中以所述第二移动信号为基准校正所述第一移动信号,以获得所述移动底盘的合成移动信号。为此,通过融合第一移动信号和第二移动信号,可以获得更加准确的移动底盘的运动信号。Optionally, fusing the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis includes: converting the first movement signal and the second movement signal into the same coordinate system, The first movement signal is corrected using the second movement signal as a reference in the same coordinate system to obtain a composite movement signal of the mobile chassis. To this end, by fusing the first movement signal and the second movement signal, a more accurate movement signal of the mobile chassis can be obtained.
可选地,根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像对所述移动机械臂进行路径规划之前还包括:协调所述震动信号、所述合成移动信号以及所述摄像头采集的图像的采样率。为此,可以提高信号处理的效率,进而提高移动机械臂的工作效率。Optionally, before performing path planning on the mobile manipulator according to the vibration signal, the synthetic movement signal and the image collected by the camera, it further includes: coordinating the vibration signal, the synthetic movement signal and the camera The sampling rate of the collected images. To this end, the efficiency of signal processing can be improved, thereby improving the working efficiency of the mobile robotic arm.
可选地,所述移动机械臂还包括第一控制器和第二控制器,方法包括:在所述第一控制器根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像信息对所述移动机械臂进行路径规划,并在所述第二控制器根据路径规划的结果对所述臂体进行控制。为此,无需改变控制器本身的结构,提高了硬件开发的效率。Optionally, the mobile manipulator further includes a first controller and a second controller, and the method includes: in the first controller based on the vibration signal, the synthesized movement signal and the image information collected by the camera A path is planned for the mobile robotic arm, and the second controller controls the arm body according to the result of the path planning. To this end, there is no need to change the structure of the controller itself, which improves the efficiency of hardware development.
本发明还提出了一种移动机械臂的控制装置,所述移动机械臂包括移动底盘和安装在所述移动底盘上的臂体,所述移动底盘上设有惯性测量单元和测距仪,所述臂体上设有摄像头,所述装置包括:第一获取模块,获取所述惯性测量单元提供的所述移动底盘的运动信号,并根据所述运动信号解析出所述移动底盘的第一移动信号和震动信号;第二获取模块,获取所述测距仪感测的第二移动信号,融合所述第一移动信号和所述第二移动信号以获得所述移动底盘的合成移动信号;控制模块,根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像对所述移动机械臂进行路径规划,并根据路径规划的结果对所述臂体进行控制。The invention also proposes a control device for a mobile robotic arm. The mobile robotic arm includes a mobile chassis and an arm body installed on the mobile chassis. The mobile chassis is provided with an inertial measurement unit and a rangefinder. A camera is provided on the arm, and the device includes: a first acquisition module that acquires the motion signal of the mobile chassis provided by the inertial measurement unit, and analyzes the first movement of the mobile chassis based on the motion signal. signal and vibration signal; the second acquisition module acquires the second movement signal sensed by the rangefinder, and fuses the first movement signal and the second movement signal to obtain a synthetic movement signal of the mobile chassis; control A module that performs path planning on the mobile robotic arm according to the vibration signal, the synthetic movement signal and the image collected by the camera, and controls the arm body according to the result of path planning.
可选地,所述第二获取模块融合所述第一移动信号和所述第二移动信号以获得所述移动底盘的合成移动信号包括:将所述第一移动信号和所述第二移动信号转换到同一坐标系,在所述同一坐标系中以所述第二移动信号为基准校正所述第一移动信号,以获得所述移动底盘的合成移动信号。Optionally, the second acquisition module fuses the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis including: combining the first movement signal and the second movement signal Convert to the same coordinate system, and correct the first movement signal based on the second movement signal in the same coordinate system to obtain a composite movement signal of the mobile chassis.
可选地,所述控制模块根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像对所述移动机械臂进行路径规划之前还包括:协调所述震动信号、所述合成移动信号以及所述摄像头采集的图像的采样率。Optionally, before the control module performs path planning for the mobile manipulator based on the vibration signal, the synthetic movement signal and the image collected by the camera, it further includes: coordinating the vibration signal, the synthetic movement signal and the sampling rate of images collected by the camera.
可选地,所述移动机械臂还包括第一控制器和第二控制器,所述装置包括:在所述第一控制器根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像信息对所述移动机械臂进行路径规划,并在所述第二控制器根据路径规划的结果对所述臂体进行控制。Optionally, the mobile manipulator further includes a first controller and a second controller, and the device includes: in the first controller based on the vibration signal, the synthesized movement signal and the camera collected The image information is used to plan a path for the mobile robotic arm, and the second controller controls the arm body according to the result of the path planning.
本发明还提出了一种移动机械臂,所述移动机械臂包括移动底盘和安装在所述移动底 盘上的臂体,所述移动底盘上设有惯性测量单元和测距仪,所述臂体上设有摄像头,所述移动机械臂还包括控制器,所述控制器配置为:获取所述惯性测量单元提供的所述移动底盘的运动信号,并根据所述运动信号解析出所述移动底盘的第一移动信号和震动信号;获取所述测距仪感测的第二移动信号,融合所述第一移动信号和所述第二移动信号以获得所述移动底盘的合成移动信号;根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像对所述移动机械臂进行路径规划,并根据路径规划的结果对所述臂体进行控制。The invention also proposes a mobile mechanical arm. The mobile mechanical arm includes a mobile chassis and an arm body installed on the mobile chassis. The mobile chassis is provided with an inertial measurement unit and a rangefinder. The arm body A camera is provided on the mobile manipulator, and the mobile manipulator also includes a controller configured to: obtain the motion signal of the mobile chassis provided by the inertial measurement unit, and analyze the mobile chassis based on the motion signal. The first movement signal and vibration signal; obtain the second movement signal sensed by the rangefinder, and fuse the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis; according to the The vibration signal, the synthetic movement signal and the image collected by the camera perform path planning on the mobile robotic arm, and the arm body is controlled according to the result of path planning.
可选地,所述控制器包括第一控制器和第二控制器,所述第一控制器根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像信息对所述移动机械臂进行路径规划,所述第二控制器根据路径规划的结果对所述臂体进行控制。Optionally, the controller includes a first controller and a second controller. The first controller controls the mobile manipulator according to the vibration signal, the synthesized movement signal and the image information collected by the camera. Perform path planning, and the second controller controls the arm body according to the result of path planning.
本发明还提出了一种电子设备,包括处理器、存储器和存储在所述存储器中的指令,其中所述指令被所述处理器执行时实现如上所述的方法。The present invention also proposes an electronic device, including a processor, a memory and instructions stored in the memory, wherein when the instructions are executed by the processor, the above method is implemented.
本发明还提出了一种计算机可读存储介质,其上存储有计算机指令,所述计算机指令在被运行时执行如上所述的方法。The present invention also proposes a computer-readable storage medium on which computer instructions are stored, which execute the method as described above when executed.
本发明还提出了一种计算机程序产品,其特征在于,包括计算机程序,所述计算机程序被处理器执行时实施如上所述的方法。The present invention also proposes a computer program product, which is characterized in that it includes a computer program that implements the above method when executed by a processor.
附图说明Description of drawings
以下附图仅旨在于对本发明做示意性说明和解释,并不限定本发明的范围。其中,The following drawings are only intended to schematically illustrate and explain the present invention and do not limit the scope of the present invention. in,
图1是根据本发明的一实施例的一种移动机械臂的控制方法的流程图;Figure 1 is a flow chart of a control method for a mobile robotic arm according to an embodiment of the present invention;
图2是根据本发明的一实施例的一种移动机械臂的应用场景的示意图;Figure 2 is a schematic diagram of an application scenario of a mobile robotic arm according to an embodiment of the present invention;
图3是根据本发明的一实施例的一种移动机械臂的功能框图;Figure 3 is a functional block diagram of a mobile robotic arm according to an embodiment of the present invention;
图4是根据本发明的一实施例的一种移动机械臂的控制装置的示意图;Figure 4 is a schematic diagram of a control device for a mobile robotic arm according to an embodiment of the present invention;
图5是根据本发明的一实施例的一种电子设备的示意图。Figure 5 is a schematic diagram of an electronic device according to an embodiment of the present invention.
附图标记说明Explanation of reference signs
100移动机械臂的控制方法100 Control method of mobile robotic arm
110-130步骤Steps 110-130
21移动机械臂21Mobile robotic arm
201移动底盘201 mobile chassis
202臂体202 arm body
203惯性测量单元203 Inertial Measurement Unit
204摄像头204 cameras
205控制器205 controller
205a分解单元205a decomposition unit
205b融合单元205b fusion unit
205c图像处理单元205c image processing unit
205d采样协调单元205d sampling coordination unit
205e路径规划单元205e Path Planning Unit
206测距仪206 rangefinder
207行走单元207 walking unit
208夹具208 fixture
410第一获取模块410 first acquisition module
420第二获取模块420 second acquisition module
430控制模块430 control module
500电子设备500 Electronic Equipment
510处理器510 processor
520存储器520 memory
具体实施方式Detailed ways
为了对本发明的技术特征、目的和效果有更加清楚的理解,现对照附图说明本发明的具体实施方式。In order to have a clearer understanding of the technical features, purposes and effects of the present invention, the specific embodiments of the present invention will now be described with reference to the accompanying drawings.
在下面的描述中阐述了很多具体细节以便于充分理解本发明,但是本发明还可以采用其它不同于在此描述的其它方式来实施,因此本发明不受下面公开的具体实施例的限制。Many specific details are set forth in the following description to fully understand the present invention, but the present invention can also be implemented in other ways different from those described here, so the present invention is not limited to the specific embodiments disclosed below.
如本申请和权利要求书中所示,除非上下文明确提示例外情形,“一”、“一个”、“一种”和/或“该”等词并非特指单数,也可包括复数。一般说来,术语“包括”与“包含”仅提示包括已明确标识的步骤和元素,而这些步骤和元素不构成一个排它性的罗列,方法或者设备也可能包含其他的步骤或元素。As shown in this application and claims, words such as "a", "an", "an" and/or "the" do not specifically refer to the singular and may include the plural unless the context clearly indicates an exception. Generally speaking, the terms "comprising" and "comprising" only imply the inclusion of clearly identified steps and elements, and these steps and elements do not constitute an exclusive list. The method or apparatus may also include other steps or elements.
图2是根据本发明的一实施例的一种移动机械臂的应用场景的示意图,如图2所示,该应用场景包括移动机械臂21和工件22,移动机械臂21包括移动底盘201和臂体202,移动底盘201下设有行走单元207,使得移动机械臂21可以移动,移动底盘201上还设有测距仪206(未示出),用于测量移动底盘201的位移,测距仪206可以是里程计或者激光雷达,移动底盘201上设有惯性测量单元203,用于感测移动底盘201的加速度信号和角 速度信号。臂体202安装在移动底盘201上,典型的臂体202可以具有六自由度,以灵活地抓取工件22,臂体202上安装有摄像头204,摄像头204可以采集环境图像,以进行环境感知并从环境图像中识别出目标工件,臂体202的末端设有可张开的夹具208,以夹持和放下工件22。Figure 2 is a schematic diagram of an application scenario of a mobile robotic arm according to an embodiment of the present invention. As shown in Figure 2, the application scenario includes a mobile robotic arm 21 and a workpiece 22. The mobile robotic arm 21 includes a mobile chassis 201 and an arm. The body 202 is provided with a walking unit 207 under the mobile chassis 201 so that the mobile robot arm 21 can move. A rangefinder 206 (not shown) is also provided on the mobile chassis 201 for measuring the displacement of the mobile chassis 201. The rangefinder 206 may be an odometer or a laser radar. The mobile chassis 201 is provided with an inertial measurement unit 203 for sensing the acceleration signal and angular velocity signal of the mobile chassis 201 . The arm body 202 is installed on the mobile chassis 201. A typical arm body 202 can have six degrees of freedom to flexibly grasp the workpiece 22. A camera 204 is installed on the arm body 202. The camera 204 can collect environmental images for environmental perception and processing. The target workpiece is identified from the environment image, and an expandable clamp 208 is provided at the end of the arm body 202 to clamp and lower the workpiece 22 .
本发明提出了一种移动机械臂的控制方法,图1是根据本发明的一实施例的一种移动机械臂的控制方法100的流程图,下面结合图1和图2本发明的实施例中的移动机械臂的控制方法进行说明,如图1所示,方法100包括:The present invention proposes a control method for a mobile robotic arm. Figure 1 is a flow chart of a control method 100 for a mobile robotic arm according to an embodiment of the present invention. The following is a combination of Figures 1 and 2 in the embodiment of the present invention. The control method of the mobile robot arm is explained. As shown in Figure 1, the method 100 includes:
步骤110,获取惯性测量单元提供的移动底盘的运动信号,并根据运动信号解析出移动底盘的第一移动信号和震动信号。Step 110: Obtain the motion signal of the mobile chassis provided by the inertial measurement unit, and analyze the first motion signal and vibration signal of the mobile chassis based on the motion signal.
惯性测量单元(IMU)是陀螺仪和加速度计的结合体,其中陀螺仪用于感测移动底盘201的三轴角速度信号,加速度计用于感测移动底盘的三轴加速度信号,可以由这两种信号通过姿态融合算法计算出移动底盘的运动信号,并通过频率特征将运动信号中的第一移动信号和震动信号分离出来,第一移动信号可以是时序的移动底盘的位移值和速度值,震动信号可以是时序的移动底盘的震动幅值和速度值。The inertial measurement unit (IMU) is a combination of a gyroscope and an accelerometer. The gyroscope is used to sense the three-axis angular velocity signal of the mobile chassis 201, and the accelerometer is used to sense the three-axis acceleration signal of the mobile chassis. These two can be used. The third signal calculates the motion signal of the mobile chassis through the attitude fusion algorithm, and separates the first motion signal and the vibration signal in the motion signal through frequency characteristics. The first motion signal can be the displacement value and speed value of the mobile chassis in time series, The vibration signal may be a time series of vibration amplitude and speed values of the moving chassis.
图3是根据本发明的一实施例的一种移动机械臂的功能框图,如图2和图3所示,惯性测量单元203感测了移动底盘的三轴角速度信号和三轴加速度信号,三轴角速度信号和三轴加速度信号通过姿态融合算法计算为运动信号,该运动信号被发送至控制器205中的分离单元205a,分离单元205a通过频率特征分离出移动底盘201的第一移动信号和震动信号,其中第一移动信号被发送至融合模块205b,震动信号被发送至采样协调单元205d。Figure 3 is a functional block diagram of a mobile robotic arm according to an embodiment of the present invention. As shown in Figures 2 and 3, the inertial measurement unit 203 senses the three-axis angular velocity signal and the three-axis acceleration signal of the mobile chassis. The axis angular velocity signal and the three-axis acceleration signal are calculated as motion signals through the posture fusion algorithm. The motion signals are sent to the separation unit 205a in the controller 205. The separation unit 205a separates the first movement signal and vibration of the mobile chassis 201 through frequency characteristics. signals, where the first movement signal is sent to the fusion module 205b and the vibration signal is sent to the sampling coordination unit 205d.
步骤120,获取测距仪感测的第二移动信号,融合第一移动信号和第二移动信号以获得移动底盘的合成移动信号。Step 120: Obtain the second movement signal sensed by the rangefinder, and fuse the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis.
测距仪206可以是里程计和/或激光雷达,用于感测移动底盘201的第二移动信号,该第二移动信号被发送至控制器205的融合单元205b,融合单元205b融合测距仪发送的第二移动信号和分离单元205a分离出的移动底盘的第一移动信号,可以得到更加准确的移动底盘201的合成移动信号。The rangefinder 206 may be an odometer and/or a lidar, and is used to sense the second movement signal of the mobile chassis 201. The second movement signal is sent to the fusion unit 205b of the controller 205, and the fusion unit 205b fuses the rangefinder. By using the sent second movement signal and the first movement signal of the mobile chassis separated by the separation unit 205a, a more accurate synthetic movement signal of the mobile chassis 201 can be obtained.
在一些实施例中,融合第一移动信号和第二移动信号以获得移动底盘的合成移动信号包括:将第一移动信号和第二移动信号转换到同一坐标系,在同一坐标系中以第二移动信号为基准校正第一移动信号,以获得移动底盘的合成移动信号。以激光雷达作为测距仪为例,激光雷达感测的第二移动信号精准度更高,信号点分散,但是测量距离是相对特征点而言的,惯性测量单元获取的第一移动信号精准度稍差,信号点密集,但是测量距离是相对移动底盘自身而言的,通过融合第一移动信号和第二移动信号,可以获得更加准确的移 动底盘的运动信号。具体地,将第一移动信号和第二移动信号变换到同一坐标系,第一移动信号的采样点相对密集,第二移动信号的采样点相对离散,以第二移动信号的采样点作为基准,对第一移动信号和第二移动信号进行加权计算,从而实现了第一移动信号和第二移动信号的融合。In some embodiments, fusing the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis includes: converting the first movement signal and the second movement signal into the same coordinate system, and using the second movement signal in the same coordinate system. The movement signal is used as a reference to correct the first movement signal to obtain a composite movement signal of the mobile chassis. Taking lidar as a rangefinder as an example, the second moving signal sensed by lidar is more accurate and the signal points are scattered, but the measured distance is relative to the feature points. The first moving signal obtained by the inertial measurement unit is more accurate. Slightly worse, the signal points are dense, but the measurement distance is relative to the mobile chassis itself. By fusing the first mobile signal and the second mobile signal, a more accurate motion signal of the mobile chassis can be obtained. Specifically, the first mobile signal and the second mobile signal are transformed into the same coordinate system. The sampling points of the first mobile signal are relatively dense, and the sampling points of the second mobile signal are relatively discrete. Taking the sampling points of the second mobile signal as a benchmark, Weighting calculation is performed on the first mobile signal and the second mobile signal, thereby realizing the fusion of the first mobile signal and the second mobile signal.
步骤130,根据震动信号、合成移动信号以及摄像头采集的图像对移动机械臂进行路径规划,并根据路径规划的结果对臂体进行控制。Step 130: Plan the path of the mobile robotic arm based on the vibration signal, the synthetic movement signal and the image collected by the camera, and control the arm body according to the result of the path planning.
摄像头204实时采集环境图像,该环境图像被发送至图像处理单元205c,图像处理单元205c对环境图像进行滤波、降噪、目标识别等处理。路径规划单元205e获取分离单元205a分离的震动信号,融合单元205b提供的合成移动信号,图像处理单元205c处理的图像信号,计算得到震动信息、移动信息和图像信息,采用路径规划算法根据震动信息、移动信息以及摄像头采集的图像信息对移动机械臂进行路径规划,路径规划算法可以是PRM路径规划算法(随机路线图算法)或RRT算法(快速扩展随机树算法)等,随后根据规划的路径对臂体进行控制,为此,通过感测移动底盘的震动和移动,可以在臂体运动时补偿移动底盘的震动和移动,臂体无需在移动底盘停止住时即可稳定地执行任务,提高移动机械臂的工作效率,扩展移动机械臂的应用场景。The camera 204 collects environmental images in real time, and the environmental images are sent to the image processing unit 205c. The image processing unit 205c performs filtering, noise reduction, target recognition and other processing on the environmental images. The path planning unit 205e acquires the vibration signal separated by the separation unit 205a, the synthetic movement signal provided by the fusion unit 205b, and the image signal processed by the image processing unit 205c, calculates the vibration information, movement information and image information, and uses a path planning algorithm according to the vibration information, Mobile information and image information collected by the camera are used to plan the path of the mobile robotic arm. The path planning algorithm can be PRM path planning algorithm (random road map algorithm) or RRT algorithm (rapidly expanding random tree algorithm), etc., and then the arm is planned according to the planned path. For this reason, by sensing the vibration and movement of the mobile chassis, the vibration and movement of the mobile chassis can be compensated when the arm moves. The arm can perform tasks stably without stopping the mobile chassis, improving mobile machinery. The working efficiency of the arm expands the application scenarios of the mobile robotic arm.
在一些实施例中,根据震动信号、合成移动信号以及摄像头采集的图像对移动机械臂进行路径规划之前还包括:协调震动信号、合成移动信号以及摄像头采集的图像的采样率。具体地,如图5所示,控制器205还包括采样协调单元205d,由于震动信号、合成移动信号以及摄像头采集的图像具有不同的采样率,采样协调单元205d接收到震动信号、合成移动信号以及摄像头采集的图像之后,协调震动信号、合成移动信号以及摄像头采集的图像的采样率,即确定向路径规划单元205e发送这些信号的频率和时机,为此,可以提高信号处理的效率,进而提高移动机械臂的工作效率。In some embodiments, before planning the path of the mobile manipulator based on the vibration signal, the synthetic movement signal, and the image collected by the camera, it also includes: coordinating the sampling rate of the vibration signal, the synthetic movement signal, and the image collected by the camera. Specifically, as shown in Figure 5, the controller 205 also includes a sampling coordination unit 205d. Since the vibration signal, the synthetic movement signal and the image collected by the camera have different sampling rates, the sampling coordination unit 205d receives the vibration signal, the synthetic movement signal and After the image collected by the camera is coordinated, the vibration signal, the synthesized movement signal and the sampling rate of the image collected by the camera are determined, that is, the frequency and timing of sending these signals to the path planning unit 205e are determined. To this end, the efficiency of signal processing can be improved, thereby improving mobile The efficiency of the robotic arm.
在一些实施例中,移动机械臂还包括第一控制器和第二控制器,方法包括:在第一控制器根据震动信号、合成移动信号以及摄像头采集的图像信息对移动机械臂进行路径规划,并在第二控制器根据路径规划的结果对臂体进行控制。具体地,第一控制器是用于控制移动底盘的控制器,第二控制器是用于控制臂体的控制器,即移动底盘和臂体本身的控制器,在第一控制器根据震动信号、合成移动信号以及摄像头采集的图像对移动机械臂进行路径规划,并在第二控制器根据路径规划的结果对臂体进行控制,为此,无需改变控制器本身的结构,提高了硬件开发的效率。In some embodiments, the mobile robotic arm further includes a first controller and a second controller, and the method includes: performing path planning on the mobile robotic arm in the first controller based on the vibration signal, the synthesized movement signal, and the image information collected by the camera, And the second controller controls the arm body according to the result of path planning. Specifically, the first controller is a controller used to control the mobile chassis, and the second controller is a controller used to control the arm body, that is, the controller of the mobile chassis and the arm body itself. In the first controller according to the vibration signal , synthesize the mobile signals and the images collected by the camera to plan the path of the mobile robotic arm, and control the arm body according to the results of the path planning in the second controller. To this end, there is no need to change the structure of the controller itself, which improves the efficiency of hardware development. efficiency.
本发明的实施例中提出了一种移动机械臂的控制方法,通过感测移动底盘的震动和移动,可以在臂体运动时补偿移动底盘的震动和移动,臂体无需在移动底盘停止住时即可稳 定地执行任务,提高移动机械臂的工作效率,扩展移动机械臂的应用场景。An embodiment of the present invention proposes a control method for a mobile robotic arm. By sensing the vibration and movement of the mobile chassis, the vibration and movement of the mobile chassis can be compensated when the arm moves. The arm does not need to stop when the mobile chassis stops. It can perform tasks stably, improve the work efficiency of the mobile robotic arm, and expand the application scenarios of the mobile robotic arm.
本发明还提出了一种移动机械臂的控制装置,移动机械臂包括移动底盘和安装在移动底盘上的臂体,移动底盘上设有惯性测量单元和测距仪,臂体上设有摄像头,图4是根据本发明的一实施例的一种移动机械臂的控制装置400的示意图,如图4所示,装置400包括:The invention also proposes a control device for a mobile robotic arm. The mobile robotic arm includes a mobile chassis and an arm body installed on the mobile chassis. The mobile chassis is provided with an inertial measurement unit and a rangefinder, and the arm body is provided with a camera. Figure 4 is a schematic diagram of a control device 400 for a mobile robot arm according to an embodiment of the present invention. As shown in Figure 4, the device 400 includes:
第一获取模块410,获取惯性测量单元提供的移动底盘的运动信号,并根据运动信号解析出移动底盘的第一移动信号和震动信号;The first acquisition module 410 acquires the motion signal of the mobile chassis provided by the inertial measurement unit, and analyzes the first motion signal and vibration signal of the mobile chassis based on the motion signal;
第二获取模块420,获取测距仪感测的第二移动信号,融合第一移动信号和第二移动信号以获得移动底盘的合成移动信号;The second acquisition module 420 acquires the second movement signal sensed by the rangefinder, and fuses the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis;
控制模块430,根据震动信号、合成移动信号以及摄像头采集的图像对移动机械臂进行路径规划,并根据路径规划的结果对臂体进行控制。The control module 430 performs path planning on the mobile robotic arm based on the vibration signal, the synthesized movement signal, and the images collected by the camera, and controls the arm body based on the results of the path planning.
在一些实施例中,第二获取模块420融合第一移动信号和第二移动信号以获得移动底盘的合成移动信号包括:将第一移动信号和第二移动信号转换到同一坐标系,在同一坐标系中以第二移动信号为基准校正第一移动信号,以获得移动底盘的合成移动信号。In some embodiments, the second acquisition module 420 fuses the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis including: converting the first movement signal and the second movement signal to the same coordinate system, in the same coordinate system The system corrects the first movement signal based on the second movement signal to obtain a composite movement signal of the mobile chassis.
在一些实施例中,控制模块430根据震动信号、合成移动信号以及摄像头采集的图像对移动机械臂进行路径规划之前还包括:协调震动信号、合成移动信号以及摄像头采集的图像的采样率。In some embodiments, before the control module 430 performs path planning on the mobile manipulator based on the vibration signal, the synthetic movement signal, and the image collected by the camera, it also includes: coordinating the sampling rate of the vibration signal, the synthetic movement signal, and the image collected by the camera.
在一些实施例中,移动机械臂还包括第一控制器和第二控制器,装置400包括:在第一控制器根据震动信号、合成移动信号以及摄像头采集的图像信息对移动机械臂进行路径规划,并在第二控制器根据路径规划的结果对臂体进行控制。In some embodiments, the mobile manipulator further includes a first controller and a second controller. The device 400 includes: the first controller performs path planning on the mobile manipulator based on the vibration signal, the synthesized movement signal, and the image information collected by the camera. , and the second controller controls the arm body according to the results of path planning.
本发明还提出了一种移动机械臂21,移动机械臂21包括移动底盘201和安装在移动底盘201上的臂体202,移动底盘201上设有惯性测量单元203和测距仪206,臂体202上设有摄像头204,移动机械臂21还包括控制器205,其特征在于,控制器205配置为:The invention also proposes a mobile robotic arm 21. The mobile robotic arm 21 includes a mobile chassis 201 and an arm body 202 installed on the mobile chassis 201. The mobile chassis 201 is provided with an inertial measurement unit 203 and a rangefinder 206. The arm body 202 is provided with a camera 204, and the mobile robot arm 21 also includes a controller 205, which is characterized in that the controller 205 is configured as:
获取惯性测量单元提供的移动底盘的运动信号,并根据运动信号解析出移动底盘的第一移动信号和震动信号;Obtain the movement signal of the mobile chassis provided by the inertial measurement unit, and analyze the first movement signal and vibration signal of the mobile chassis based on the movement signal;
获取测距仪感测的第二移动信号,融合第一移动信号和第二移动信号以获得移动底盘的合成移动信号;Obtain the second movement signal sensed by the rangefinder, and fuse the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis;
根据震动信号、合成移动信号以及摄像头采集的图像对移动机械臂进行路径规划,并根据路径规划的结果对臂体进行控制。The path planning of the mobile robotic arm is carried out based on the vibration signal, the synthetic movement signal and the images collected by the camera, and the arm body is controlled based on the results of the path planning.
在一些实施例中,控制器205包括第一控制器和第二控制器,第一控制器根据震动信号、合成移动信号以及摄像头采集的图像信息对移动机械臂进行路径规划,第二控制器根 据路径规划的结果对臂体进行控制。In some embodiments, the controller 205 includes a first controller and a second controller. The first controller performs path planning on the mobile manipulator based on vibration signals, synthetic movement signals, and image information collected by the camera. The second controller performs path planning on the mobile robot arm based on The result of path planning controls the arm body.
本发明还提出一种电子设备500。图5是根据本发明的一实施例的一种电子设备500的示意图。如图5所示,电子设备500包括处理器510和存储器520,存储器520存储中存储有指令,其中指令被处理器510执行时实现如上文所述的方法100。The present invention also provides an electronic device 500. FIG. 5 is a schematic diagram of an electronic device 500 according to an embodiment of the present invention. As shown in FIG. 5 , the electronic device 500 includes a processor 510 and a memory 520 . The memory 520 stores instructions, and when the instructions are executed by the processor 510 , the method 100 as described above is implemented.
本发明还提出一种计算机可读存储介质,其上存储有计算机指令,计算机指令在被运行时执行如上文所述的方法100。The present invention also proposes a computer-readable storage medium on which computer instructions are stored, and when executed, the computer instructions execute the method 100 as described above.
本发明还提出一种计算机程序产品,包括计算机程序,该计算机程序被处理器执行时实施如上文所述的方法100。The present invention also proposes a computer program product, which includes a computer program that implements the method 100 as described above when executed by a processor.
本发明的方法和装置的一些方面可以完全由硬件执行、可以完全由软件(包括固件、常驻软件、微码等)执行、也可以由硬件和软件组合执行。以上硬件或软件均可被称为“数据块”、“模块”、“引擎”、“单元”、“组件”或“系统”。处理器可以是一个或多个专用集成电路(ASIC)、数字信号处理器(DSP)、数字信号处理器件(DAPD)、可编程逻辑器件(PLC)、现场可编程门阵列(FPGA)、处理器、控制器、微控制器、微处理器或者其组合。此外,本发明的各方面可能表现为位于一个或多个计算机可读介质中的计算机产品,该产品包括计算机可读程序编码。例如,计算机可读介质可包括,但不限于,磁性存储设备(例如,硬盘、软盘、磁带……)、光盘(例如,压缩盘(CD)、数字多功能盘(DVD)……)、智能卡以及闪存设备(例如,卡、棒、键驱动器……)。Some aspects of the method and device of the present invention may be executed entirely by hardware, may be entirely executed by software (including firmware, resident software, microcode, etc.), or may be executed by a combination of hardware and software. The above hardware or software may be referred to as "data block", "module", "engine", "unit", "component" or "system". The processor may be one or more application specific integrated circuits (ASICs), digital signal processors (DSPs), digital signal processing devices (DAPDs), programmable logic devices (PLCs), field programmable gate arrays (FPGAs), processors , controller, microcontroller, microprocessor or combination thereof. Additionally, aspects of the invention may be embodied as a computer product embodied in one or more computer-readable media, the product including computer-readable program code. For example, computer-readable media may include, but are not limited to, magnetic storage devices (e.g., hard disks, floppy disks, tapes, etc.), optical disks (e.g., compact disks (CD), digital versatile disks (DVD), ...), smart cards and flash memory devices (e.g. cards, sticks, key drives...).
在此使用了流程图用来说明根据本申请的实施例的方法所执行的操作。应当理解的是,前面的操作不一定按照顺序来精确地执行。相反,可以按照倒序或同时处理各种步骤。同时,或将其他操作添加到这些过程中,或从这些过程移除某一步或数步操作。A flowchart is used here to illustrate operations performed by methods according to embodiments of the present application. It should be understood that the preceding operations are not necessarily performed in exact order. Instead, the various steps can be processed in reverse order or simultaneously. At the same time, other operations may be added to these processes, or a step or steps may be removed from these processes.
应当理解,虽然本说明书是按照各个实施例描述的,但并非每个实施例仅包含一个独立的技术方案,说明书的这种叙述方式仅仅是为清楚起见,本领域技术人员应当将说明书作为一个整体,各实施例中的技术方案也可以经适当组合,形成本领域技术人员可以理解的其他实施方式。It should be understood that although this specification is described in terms of various embodiments, not each embodiment only contains an independent technical solution. This description of the specification is only for the sake of clarity, and those skilled in the art should take the specification as a whole. , the technical solutions in each embodiment can also be appropriately combined to form other implementations that can be understood by those skilled in the art.
以上所述仅为本发明示意性的具体实施方式,并非用以限定本发明的范围。任何本领域的技术人员,在不脱离本发明的构思和原则的前提下所作的等同变化、修改与结合,均应属于本发明保护的范围。The above descriptions are only illustrative embodiments of the present invention and are not intended to limit the scope of the present invention. Any equivalent changes, modifications and combinations made by those skilled in the art without departing from the concept and principles of the present invention shall fall within the scope of protection of the present invention.

Claims (13)

  1. 一种移动机械臂的控制方法(100),所述移动机械臂包括移动底盘和安装在所述移动底盘上的臂体,所述移动底盘上设有惯性测量单元和测距仪,所述臂体上设有摄像头,其特征在于,所述方法(100)包括:A control method (100) for a mobile robotic arm. The mobile robotic arm includes a mobile chassis and an arm body installed on the mobile chassis. The mobile chassis is provided with an inertial measurement unit and a rangefinder. The arm A camera is provided on the body, and the characteristic is that the method (100) includes:
    获取所述惯性测量单元提供的所述移动底盘的运动信号,并根据所述运动信号解析出所述移动底盘的第一移动信号和震动信号(110);Obtain the movement signal of the mobile chassis provided by the inertial measurement unit, and parse the first movement signal and vibration signal of the mobile chassis based on the movement signal (110);
    获取所述测距仪感测的第二移动信号,融合所述第一移动信号和所述第二移动信号以获得所述移动底盘的合成移动信号(120);Obtain the second movement signal sensed by the rangefinder, and fuse the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis (120);
    根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像对所述移动机械臂进行路径规划,并根据路径规划的结果对所述臂体进行控制(130)。Perform path planning for the mobile robotic arm based on the vibration signal, the synthetic movement signal, and the image collected by the camera, and control the arm body according to the results of path planning (130).
  2. 根据权利要求1所述的方法(100),其特征在于,融合所述第一移动信号和所述第二移动信号以获得所述移动底盘的合成移动信号包括:将所述第一移动信号和所述第二移动信号转换到同一坐标系,在所述同一坐标系中以所述第二移动信号为基准校正所述第一移动信号,以获得所述移动底盘的合成移动信号。The method (100) according to claim 1, characterized in that fusing the first mobile signal and the second mobile signal to obtain a composite mobile signal of the mobile chassis includes: combining the first mobile signal and The second movement signal is converted to the same coordinate system, and the first movement signal is corrected in the same coordinate system with the second movement signal as a reference to obtain a composite movement signal of the mobile chassis.
  3. 根据权利要求1所述的方法(100),其特征在于,根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像对所述移动机械臂进行路径规划之前还包括:协调所述震动信号、所述合成移动信号以及所述摄像头采集的图像的采样率。The method (100) according to claim 1, characterized in that, before performing path planning on the mobile manipulator according to the vibration signal, the synthetic movement signal and the image collected by the camera, it further includes: coordinating the The vibration signal, the synthetic movement signal and the sampling rate of the image collected by the camera.
  4. 根据权利要求1所述的方法(100),其特征在于,所述移动机械臂还包括第一控制器和第二控制器,方法(100)包括:在所述第一控制器根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像信息对所述移动机械臂进行路径规划,并在所述第二控制器根据路径规划的结果对所述臂体进行控制。The method (100) according to claim 1, characterized in that the mobile robot arm further includes a first controller and a second controller, and the method (100) includes: in the first controller according to the vibration The signal, the synthetic movement signal and the image information collected by the camera perform path planning on the mobile robotic arm, and the second controller controls the arm body according to the result of path planning.
  5. 一种移动机械臂的控制装置(400),所述移动机械臂包括移动底盘和安装在所述移动底盘上的臂体,所述移动底盘上设有惯性测量单元和测距仪,所述臂体上设有摄像头,其特征在于,所述装置(400)包括:A control device (400) for a mobile robotic arm. The mobile robotic arm includes a mobile chassis and an arm body installed on the mobile chassis. The mobile chassis is provided with an inertial measurement unit and a rangefinder. The arm There is a camera on the body, characterized in that the device (400) includes:
    第一获取模块(410),获取所述惯性测量单元提供的所述移动底盘的运动信号,并根据所述运动信号解析出所述移动底盘的第一移动信号和震动信号;The first acquisition module (410) acquires the motion signal of the mobile chassis provided by the inertial measurement unit, and parses the first motion signal and vibration signal of the mobile chassis according to the motion signal;
    第二获取模块(420),获取所述测距仪感测的第二移动信号,融合所述第一移动信号和所述第二移动信号以获得所述移动底盘的合成移动信号;The second acquisition module (420) acquires the second movement signal sensed by the rangefinder, and fuses the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis;
    控制模块(430),根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像对所述移动机械臂进行路径规划,并根据路径规划的结果对所述臂体进行控制。The control module (430) performs path planning on the mobile robotic arm according to the vibration signal, the synthetic movement signal and the image collected by the camera, and controls the arm body according to the results of path planning.
  6. 根据权利要求5所述的装置(400),其特征在于,所述第二获取模块(420)融合所述第一移动信号和所述第二移动信号以获得所述移动底盘的合成移动信号包括:将所述第一移动信号和所述第二移动信号转换到同一坐标系,在所述同一坐标系中以所述第二移动信号为基准校正所述第一移动信号,以获得所述移动底盘的合成移动信号。The device (400) according to claim 5, characterized in that the second acquisition module (420) fuses the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis including : Convert the first movement signal and the second movement signal to the same coordinate system, and correct the first movement signal with the second movement signal as a reference in the same coordinate system to obtain the movement Synthetic movement signal of the chassis.
  7. 根据权利要求5所述的装置(400),其特征在于,所述控制模块(430)根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像对所述移动机械臂进行路径规划之前还包括:协调所述震动信号、所述合成移动信号以及所述摄像头采集的图像的采样率。The device (400) according to claim 5, characterized in that the control module (430) performs path planning on the mobile robotic arm based on the vibration signal, the synthetic movement signal and the image collected by the camera. The previous step also includes: coordinating the sampling rate of the vibration signal, the synthetic movement signal and the image collected by the camera.
  8. 根据权利要求5所述的装置(400),其特征在于,所述移动机械臂还包括第一控制器和第二控制器,所述装置(400)包括:在所述第一控制器根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像信息对所述移动机械臂进行路径规划,并在所述第二控制器根据路径规划的结果对所述臂体进行控制。The device (400) according to claim 5, characterized in that the mobile robot arm further includes a first controller and a second controller, and the device (400) includes: when the first controller operates according to the The vibration signal, the synthetic movement signal and the image information collected by the camera perform path planning on the mobile robotic arm, and the second controller controls the arm body according to the result of path planning.
  9. 一种移动机械臂(21),所述移动机械臂(21)包括移动底盘(201)和安装在所述移动底盘(201)上的臂体(202),所述移动底盘(201)上设有惯性测量单元(203)和测距仪(206),所述臂体(202)上设有摄像头(204),所述移动机械臂(21)还包括控制器(205),其特征在于,所述控制器(205)配置为:A mobile robotic arm (21). The mobile robotic arm (21) includes a mobile chassis (201) and an arm body (202) installed on the mobile chassis (201). The mobile chassis (201) is provided with There is an inertial measurement unit (203) and a rangefinder (206). The arm body (202) is provided with a camera (204). The mobile robotic arm (21) also includes a controller (205), which is characterized by: The controller (205) is configured as:
    获取所述惯性测量单元提供的所述移动底盘的运动信号,并根据所述运动信号解析出所述移动底盘的第一移动信号和震动信号;Obtain the movement signal of the mobile chassis provided by the inertial measurement unit, and parse the first movement signal and vibration signal of the mobile chassis based on the movement signal;
    获取所述测距仪感测的第二移动信号,融合所述第一移动信号和所述第二移动信号以获得所述移动底盘的合成移动信号;Obtain the second movement signal sensed by the rangefinder, and fuse the first movement signal and the second movement signal to obtain a composite movement signal of the mobile chassis;
    根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像对所述移动机械臂进行路径规划,并根据路径规划的结果对所述臂体进行控制。Perform path planning on the mobile robotic arm based on the vibration signal, the synthetic movement signal and the image collected by the camera, and control the arm body based on the results of path planning.
  10. 根据权利要求9所述的移动机械臂(21),其特征在于,所述控制器(205)包括第一控制器和第二控制器,所述第一控制器根据所述震动信号、所述合成移动信号以及所述摄像头采集的图像信息对所述移动机械臂进行路径规划,所述第二控制器根据路径规划的结果对所述臂体进行控制。The mobile robot arm (21) according to claim 9, characterized in that the controller (205) includes a first controller and a second controller, the first controller is based on the vibration signal, the The movement signal and the image information collected by the camera are synthesized to perform path planning for the mobile robotic arm, and the second controller controls the arm body according to the result of path planning.
  11. 一种电子设备(500),包括处理器(510)、存储器(520)和存储在所述存储器(520)中的指令,其中所述指令被所述处理器(510)执行时实现如权利要求1-5任一项所述的方法。An electronic device (500), including a processor (510), a memory (520) and instructions stored in the memory (520), wherein the instructions when executed by the processor (510) implement as claimed The method described in any one of 1-5.
  12. 一种计算机可读存储介质,其上存储有计算机指令,所述计算机指令在被运行时执行根据权利要求1-5中任一项所述的方法(100)。A computer-readable storage medium having computer instructions stored thereon which, when executed, perform the method (100) according to any one of claims 1-5.
  13. 一种计算机程序产品,其特征在于,包括计算机程序,所述计算机程序被处 理器执行时实施权利要求1-5中任一项所述的方法(100)。A computer program product, characterized by comprising a computer program which, when executed by a processor, implements the method (100) of any one of claims 1-5.
PCT/CN2022/115904 2022-08-30 2022-08-30 Control method and apparatus for mobile robotic arm WO2024044975A1 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
PCT/CN2022/115904 WO2024044975A1 (en) 2022-08-30 2022-08-30 Control method and apparatus for mobile robotic arm

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2022/115904 WO2024044975A1 (en) 2022-08-30 2022-08-30 Control method and apparatus for mobile robotic arm

Publications (1)

Publication Number Publication Date
WO2024044975A1 true WO2024044975A1 (en) 2024-03-07

Family

ID=90100164

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/115904 WO2024044975A1 (en) 2022-08-30 2022-08-30 Control method and apparatus for mobile robotic arm

Country Status (1)

Country Link
WO (1) WO2024044975A1 (en)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109746910A (en) * 2017-11-08 2019-05-14 欧姆龙株式会社 The control method and recording medium of movable type mechanical hand, movable type mechanical hand
US10471591B1 (en) * 2018-06-01 2019-11-12 X Development Llc Object hand-over between robot and actor
CN111070180A (en) * 2019-12-30 2020-04-28 上海海事大学 Post-disaster rescue channel detection robot based on ROS
CN112074382A (en) * 2018-05-02 2020-12-11 X开发有限责任公司 Positioning robotic sensors for object classification
CN113580116A (en) * 2020-05-01 2021-11-02 Abb瑞士股份有限公司 System and method for robotic assembly
CN113727862A (en) * 2019-02-22 2021-11-30 艾克斯瑞克知识产权有限公司 System and method for high precision printing on 3D surfaces
CN113996543A (en) * 2021-10-09 2022-02-01 西安石油大学 Intelligent garbage sorting robot
US20220118621A1 (en) * 2021-12-24 2022-04-21 Intel Corporation Enhanced robot safety perception and integrity monitoring

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109746910A (en) * 2017-11-08 2019-05-14 欧姆龙株式会社 The control method and recording medium of movable type mechanical hand, movable type mechanical hand
CN112074382A (en) * 2018-05-02 2020-12-11 X开发有限责任公司 Positioning robotic sensors for object classification
US10471591B1 (en) * 2018-06-01 2019-11-12 X Development Llc Object hand-over between robot and actor
CN113727862A (en) * 2019-02-22 2021-11-30 艾克斯瑞克知识产权有限公司 System and method for high precision printing on 3D surfaces
CN111070180A (en) * 2019-12-30 2020-04-28 上海海事大学 Post-disaster rescue channel detection robot based on ROS
CN113580116A (en) * 2020-05-01 2021-11-02 Abb瑞士股份有限公司 System and method for robotic assembly
CN113996543A (en) * 2021-10-09 2022-02-01 西安石油大学 Intelligent garbage sorting robot
US20220118621A1 (en) * 2021-12-24 2022-04-21 Intel Corporation Enhanced robot safety perception and integrity monitoring

Similar Documents

Publication Publication Date Title
CN109975792B (en) Method for correcting point cloud motion distortion of multi-line laser radar based on multi-sensor fusion
US10300600B2 (en) Control system having learning control function and control method
US11279045B2 (en) Robot pose estimation method and apparatus and robot using the same
TWI540402B (en) Motor controlling device
CN106584489B (en) The robot system for having the function for the position and direction for calculating sensor
Du et al. Online serial manipulator calibration based on multisensory process via extended Kalman and particle filters
US20180229364A1 (en) Robot system having learning control function and learning control method
JP2012173190A (en) Positioning system and positioning method
JP6622765B2 (en) Robot system
JP6761194B2 (en) Robot system, robot control method, robot controller and program
JP5169273B2 (en) Mobile robot control device and mobile robot system
CN115752507A (en) Online single-steering-wheel AGV parameter calibration method and system based on two-dimensional code navigation
Hedberg et al. Industrial robot tool position estimation using inertial measurements in a complementary filter and an EKF
WO2024044975A1 (en) Control method and apparatus for mobile robotic arm
CN113942008A (en) Overshoot detection method and robot system
Koch et al. Predictive robotic contour following using laser-camera-triangulation
CN114543786B (en) Wall climbing robot positioning method based on visual inertial odometer
CN116659490A (en) Low cost vision-inertial fusion SLAM method
CN107990893B (en) Detection method for sudden change of detection environment in two-dimensional laser radar S L AM
Koch et al. Force, acceleration and vision sensor fusion for contour following tasks with an industrial robot
Sihite et al. Attitude estimation of a high-yaw-rate Mobile Inverted Pendulum; comparison of Extended Kalman Filtering, Complementary Filtering, and motion capture
CN115229780A (en) Mechanical arm motion path planning method and device
Shu et al. Dynamic path tracking of industrial robots with high accuracy by visual servoing
Baeten et al. Combined vision/force control at corners in planar robotic contour following
García et al. Sensor fusion of vision, force and acceleration for compliant robot motion control