WO2019095506A1 - Mechanical arm and self-guiding operation method for mechanical arm - Google Patents

Mechanical arm and self-guiding operation method for mechanical arm Download PDF

Info

Publication number
WO2019095506A1
WO2019095506A1 PCT/CN2017/118090 CN2017118090W WO2019095506A1 WO 2019095506 A1 WO2019095506 A1 WO 2019095506A1 CN 2017118090 W CN2017118090 W CN 2017118090W WO 2019095506 A1 WO2019095506 A1 WO 2019095506A1
Authority
WO
WIPO (PCT)
Prior art keywords
arm
pitch
arms
length
angle
Prior art date
Application number
PCT/CN2017/118090
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 歌尔科技有限公司
Publication of WO2019095506A1 publication Critical patent/WO2019095506A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/02Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
    • B25J9/04Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
    • B25J9/048Pendulum type
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • B25J9/1605Simulation of manipulator lay-out, design, modelling of manipulator
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1638Programme controls characterised by the control loop compensation for arm bending/inertia, pay load weight/inertia

Definitions

  • the invention relates to the field of mechanical arms, and in particular to a self-guided operation method of a mechanical arm and a mechanical arm.
  • the invention provides a robot arm and a robot arm self-guided operation method for reducing the amount of calculation.
  • a self-guided operation method of a mechanical arm includes a plurality of pitch arms, and the ends of the plurality of pitch arms include an operation portion, and the plurality of pitch arms are connected end to end in the same vertical plane.
  • the plurality of pitch arms include a first pitch arm rotatably coupled to the base and a second pitch arm rotatably coupled to the first pitch arm, the method comprising: adjusting the first pitch arm and the second pitch arm to be built in the second section
  • the distance measuring device at the end of the arm points to the operating position of the operation target, and acquires a first distance between the distance measuring device and the operating position; acquires the first coordinate of the operating position in the vertical plane according to the first distance; and controls the mechanical arm
  • the plurality of pitch arms rotate, and when the operating portion operates the operating position, an angle between adjacent ones of the plurality of pitch arms and an angle between adjacent ones of the plurality of pitch arms acquired according to the first coordinate Consistent.
  • adjusting the first section arm and the second section arm to point the distance measuring device built in the end of the second section arm to the operation position of the operation target, and acquiring the first distance between the distance measuring device and the operation position comprises: Determining that the operational position is in a vertical plane of the plurality of pitch arms; and determining a planar coordinate system of the vertical plane.
  • the method further includes determining that the ranging direction of the distance measuring device is perpendicular to the extending direction of the second pitch arm to form a first right angle.
  • acquiring the first coordinate of the operation position in the vertical plane according to the first distance comprises: acquiring a first angle between the first section arm and the second section arm, a first length of the first section arm, and a second section a second length of the arm; and obtaining the first coordinate based on the first distance, the first angle, the first length, the second length, and the first right angle.
  • an angle between adjacent ones of the plurality of pitch arms and an angle between adjacent ones of the plurality of pitch arms acquired according to the first coordinate include: When the robot arm includes four pitch arms, acquiring a second length of the second pitch arm, a third length of the third pitch arm, and a fourth length of the fourth pitch arm, and according to the first coordinate, the second length, and the third The length and the fourth length acquire an angle between adjacent ones of the plurality of pitch arms.
  • acquiring an angle between adjacent ones of the plurality of pitch arms according to the first coordinate, the second length, the third length, and the fourth length includes:
  • ⁇ 1 ⁇ 1 -90°
  • ⁇ 2 ⁇ 2 -90°
  • ⁇ 3 ⁇ 3 -90°
  • ⁇ 1 is the first arm and adjacent a second angle between the second section arms
  • ⁇ 2 is a third angle between the second section arm and the adjacent third section arm
  • ⁇ 3 is a fourth angle between the third section arm and the fourth section arm
  • l 1 is the second length
  • l 2 is the third length
  • l 3 is the fourth length
  • (x, y) is the first coordinate.
  • the invention also provides a mechanical arm for the self-guided operation method of the foregoing mechanical arm, the mechanical arm comprises a plurality of pitch arms, the plurality of pitch arms are connected end to end in the same vertical plane, and the plurality of pitch arms comprise a base
  • the robot arm further comprises a distance measuring device and a control device, and the distance measuring device is built in the first a second arm end for obtaining a first distance between the distance measuring device and an operation position of the operation target;
  • the control device is configured to acquire the first coordinate of the operation position in the vertical plane according to the first distance, and control the plurality of robot arms
  • the pitch arm is rotated such that when the robot arm operates the operating position, an angle between adjacent ones of the plurality of pitch arms coincides with an angle between adjacent ones of the plurality of pitch arms acquired according to the first coordinate.
  • the ranging direction of the distance measuring device and the extending direction of the second pitch arm are perpendicular to each other at a first right angle.
  • the plurality of pitch arms are connected end to end in the same vertical plane, and the plurality of pitch arms are connected by a rotary joint, and the rotation axial direction of the rotary joint and the extension of the adjacent two joint arms connected by the rotary joint are respectively The directions are perpendicular to each other such that the plurality of pitch arms are connected end to end in the same vertical plane.
  • the distance measuring device is further configured to: determine that the operating position is located in a vertical plane of the plurality of pitch arms; and determine a planar coordinate system of the vertical plane.
  • control device is configured to acquire the first coordinate of the operation position in the vertical plane according to the first distance, comprising: the control device is configured to acquire the first angle between the first section arm and the second section arm, and the first section arm a first length and a second length of the second pitch arm; and control means for obtaining the first coordinate based on the first distance, the first angle, the first length, the second length, and the first right angle.
  • control device is configured to control the plurality of pitch arms of the mechanical arm to rotate with each other, so that when the mechanical arm operates the operating position, the angle between the adjacent pitch arms of the plurality of pitch arms is obtained according to the plurality of the first coordinate
  • the angle between the adjacent pitch arms in the pitch arm is uniform, including: when the mechanical arm includes four pitch arms, the control device is configured to acquire the second length of the second pitch arm, the third length of the third pitch arm, and the fourth A fourth length of the pitch arm, and a control device for obtaining an angle between adjacent ones of the plurality of pitch arms based on the first coordinate, the second length, the third length, and the fourth length.
  • control device is configured to acquire an angle between adjacent ones of the plurality of pitch arms according to the first coordinate, the second length, the third length, and the fourth length, including:
  • ⁇ 1 ⁇ 1 -90°
  • ⁇ 2 ⁇ 2 -90°
  • ⁇ 3 ⁇ 3 -90°
  • ⁇ 1 is the first arm and adjacent a second angle between the second section arms
  • ⁇ 2 is a third angle between the second section arm and the adjacent third section arm
  • ⁇ 3 is a fourth angle between the third section arm and the fourth section arm
  • l 1 is the second length
  • l 2 is the third length
  • l 3 is the fourth length
  • (x, y) is the first coordinate.
  • the distance measuring device is a laser distance measuring device, an infrared distance measuring device or an ultrasonic distance measuring device.
  • the operating portion is a mechanical gripper, a welding head, a punching head or a hook.
  • the inverse solution of the three-dimensional space of the mechanical arm is performed by positioning the plurality of pitch arms of the mechanical arm and the operation position of the operation target in the same vertical plane. Convert to a two-dimensional space operation to simplify the calculation process, reduce the amount of calculations, and improve system processing performance. Moreover, compared with the prior art, the method of using visual or pan/tilt guidance can effectively save space and reduce hardware cost.
  • Figure 1 is a schematic view showing the structure of a robot arm of the present invention
  • FIG. 2 is a schematic view showing the principle of positioning operation of the distance measuring device of the mechanical arm of the present invention
  • 3 is a schematic view showing the positional relationship of each of the arm arms when the robot arm grasps the operation target of the present invention
  • Figure 4 is a simplified schematic view of Figure 3;
  • Fig. 5 is a flow chart showing the method of self-guided operation of the robot arm of the present invention.
  • the present invention provides a mechanical arm including a base 10 and a plurality of pitch arms.
  • the plurality of pitch arms are disposed end to end in the same vertical plane, and the plurality of pitch arms include a rotational connection with the base.
  • the robot arm further includes a distance measuring device 30 and a control device, and the distance measuring device 30 is fixedly disposed at the end of the second section arm 12 for acquiring Determining a first distance between the distance measuring device and an operating position of the operation target;
  • the control device is configured to acquire the first coordinate of the operating position in the vertical plane according to the first distance, and control the rotation of the plurality of pitch arms of the mechanical arm, so that the mechanical When the arm operates the operation position of the operation target, an angle between adjacent ones of the plurality of pitch arms coincides with an angle between adjacent ones of the plurality of pitch arms acquired according to the first coordinate.
  • control device is configured to acquire a first distance between the distance measuring device 30 and the operating position of the operation target 50 and the first pitch arm 11 and the second pitch arm 12 when the distance measuring device 30 positions the operation target of the operation portion 40.
  • the angle between the operation target 50 relative to the base 10, that is, the first coordinate of the operation position of the operation target in the vertical plane, and the rotation angle of each of the plurality of pitch arms is calculated according to the first coordinate.
  • the control device in turn controls the rotation of each of the pitch arms in accordance with the respective angle of rotation.
  • the invention converts the inverse solution operation of the three-dimensional space of the mechanical arm into the operation of the two-dimensional space by arranging the operation positions of the plurality of pitch arms and the operation target of the mechanical arm in the same vertical plane, thereby simplifying the calculation process and reducing the calculation amount. Improve system processing performance. Moreover, compared with the prior art, the method of using visual or pan/tilt guidance can effectively save space and reduce hardware cost.
  • the distance measuring direction of the distance measuring device 30 and the extending direction of the second pitch arm 12 are perpendicular to each other at a first right angle, which facilitates calculation and increases the calculation speed, thereby improving the response speed of the entire mechanical arm.
  • the plurality of pitch arms are connected end to end in the same vertical plane, and the plurality of pitch arms are connected by a rotary joint, and the rotation axial direction of the rotary joint and the extension of the adjacent two joint arms connected by the rotary joint are respectively The directions are perpendicular to each other such that the plurality of pitch arms are connected end to end in the same vertical plane.
  • the rotation axis of the first section arm 11 extends in the extending direction of the first section arm, that is, the rotation axis of the first section arm 11 is its own axis, and rotates about the axis when moving; the second section arm 12 and The extending direction of the rear rotating shaft is perpendicular to the extending direction of the first pitch arm 11, so that the other pitch arms are located in the same vertical plane.
  • the distance measuring device 30 is embedded inside the second pitch arm 12 to avoid interference with the distance measuring device 30 when the pitch arms are rotated.
  • the distance measuring device 30 can adopt a laser ranging device or an infrared ranging device, and fix the distance measuring device 30 on the second pitch arm 12, and emit a fixed angle of laser or infrared light with respect to the second pitch arm 12, and rotate the first The arm 11 is thereby moved to move the second pitch arm 12, the distance measuring device 30 and the other pitch arms into the same plane as the operation target 50.
  • the angle between the second section arm 12 and the first section arm 11 is adjusted, so that the laser or infrared light sent by the distance measuring device 30 can be positioned and aligned with the operation target 50, so that the distance between the distance measuring device 30 and the operation target 50 can be measured.
  • the control device communicates with the distance measuring device 30 to obtain its first distance to the operation target 50, and acquires an angle between the first pitch arm 11 and the second pitch arm 12 at this time for subsequent calculation.
  • the ranging device 30 can also employ an ultrasonic ranging device.
  • the acquiring, by the control device, the first coordinate of the operating position in the vertical plane according to the first distance comprises: the control device configured to acquire the first angle between the first pitch arm and the second pitch arm, and the first of the first pitch arm a length and a second length of the second pitch arm; and a control device for acquiring the first coordinate based on the first distance, the first angle, the first length, the second length, and the first right angle.
  • the operation position and the manipulator of the operation target 50 are simplified to the relationship between the point and the line, and the plane coordinate system is determined.
  • the O point is the origin of the plane coordinate system
  • the OP (the extension direction of the first section arm) is the plane coordinate.
  • the Y axis of the system, the OS is perpendicular to the OP, and is located in the plane of the arm, as the X axis of the plane coordinate system.
  • the point O is generally the intersection of the first arm axis and the base.
  • Point P is the hinge center point of the first section arm 11 and the second section arm 12, and point Q is the distance measuring device 30, and O' is the horizontal projection point of the operation target 50 to the robot arm.
  • OP is the distance from the origin of the robot arm coordinate system to the end of the first section arm 11 and is a known distance;
  • PQ is the distance from the end of the first section arm 11 to the distance measuring device 30, which is also a known distance;
  • QR is the operation target 50 The distance of the operating position from the distance measuring device 30 can be measured by the distance measuring device 30.
  • OO' is the vertical distance between the operation target 50 and the origin of the coordinate system of the plane where the robot arm is located
  • RO' is the horizontal distance between the operation target 50 and the origin of the coordinate system of the plane of the robot arm
  • the control device has stored the known conditions before use, and obtains the corresponding data of the distance measuring device 30 in real time. Using the above calculation formula, the first coordinate of the operation target 50 in the plane of the robot arm is obtained (RO', OO ').
  • the control device is configured to control the plurality of pitch arms of the robot arm to rotate with each other, so that when the mechanical arm operates the operation position of the operation target, the angle between the adjacent pitch arms of the plurality of pitch arms is obtained according to the first coordinate
  • the angle between the adjacent pitch arms of the plurality of pitch arms is identical, and specifically includes: when the mechanical arm includes four pitch arms, the control device is configured to acquire the second length of the second pitch arm and the third length of the third pitch arm And a fourth length of the fourth pitch arm, and the control device is configured to obtain an angle between the adjacent pitch arms of the plurality of pitch arms according to the first coordinate, the second length, the third length, and the fourth length.
  • the robot arm includes four pitch arms.
  • the mechanical arm further includes a third section arm 13 rotatably coupled to the second section arm 12 and a fourth section arm 14 rotatably coupled to the third section arm 13, wherein the third section arm 13 and the fourth section
  • the extending direction of the rotating shaft of the pitch arm 14 is perpendicular to the extending direction of the first pitch arm, that is, the rotating axes of the second pitch arm 12, the third pitch arm 13 and the fourth pitch arm 14 are perpendicular to the first pitch arm 11, whereby, it can be ensured that the second, third and fourth section arms and the first section arm 11 are always in the same plane.
  • the pitch arms having the rotational connection relationship are connected by the rotary joint, and the rotary joint is driven and controlled by the steering gear or the servo motor.
  • the base 10 and the first pitch arm 11 are connected by a rotary joint 21
  • the first pitch arm 11 and the second pitch arm 12 are connected by a rotary joint 22
  • the second pitch arm 12 and the third pitch arm 13 pass the rotary joint 23
  • the third arm 13 and the fourth arm 14 are connected by a rotary joint 24, and the fourth arm 14 and the operating portion 40 may be connected by a rotary joint 25.
  • the rotation of the single rotating joint adopts an independent control mode, that is, each rotating joint rotates independently, and the joint arm connected thereto is driven to move independently, thereby avoiding the mutual interference of the motion of each joint arm and affecting the operation of the mechanical arm.
  • the control device issues a rotation command including a rotation direction and a rotation angle to independently control the movement of each of the rotary joints.
  • the robot arm determines the first coordinate of the operation target 50 in the plane of the robot arm, and performs an operation action on the operation target 50. At this time, the positional relationship between the respective arm arms is as shown in FIGS. 3 and 4.
  • A, B, and C are the rotary joints 22, 23, and 24, respectively, and when the operation portion 40 grasps the operation target 50, the operation target 50 can be simplified to the point D.
  • the relative relationship of the chain manipulators is processed by the D-H model in the three-dimensional space.
  • the D-H model is used to process the coordinate relationship, and it is known that:
  • the coordinate of D in the C coordinate system is (l 3 cos ⁇ 3 , l 3 sin ⁇ 3 );
  • the homogeneous transformation matrix of the coordinate system at C relative to the coordinate system at B is
  • the homogeneous transformation matrix of the coordinate system at B relative to the coordinate system at A is
  • ⁇ 1 ⁇ 1 -90°
  • ⁇ 2 ⁇ 2 -90°
  • ⁇ 3 ⁇ 3 -90°
  • ⁇ 1 is the second angle between the second pitch arm and the first pitch arm
  • ⁇ 2 is a third angle between the third section arm and the second section arm
  • ⁇ 3 is a fourth angle between the fourth section arm and the third section arm
  • l 1 is the length of the second section arm
  • l 2 is the third The length of the pitch arm
  • l 3 is the length of the fourth pitch arm
  • (x, y) is the mechanical arm positioning and calculates the first coordinate of the acquired operational target 50 in the plane of the mechanical arm.
  • the above formula is solved to determine a second angle ⁇ 1 of the second section arm relative to the rotation of the first section arm, and the third section arm is rotated relative to the second section arm The third angle ⁇ 2 and the fourth angle ⁇ 3 of the fourth pitch arm relative to the third pitch arm rotation.
  • each of the rotating joints is controlled to rotate through a corresponding angle, and the operating portion 40 is moved to the operation target 50.
  • the above matrix contains three unknown variables, and it can be assumed that ⁇ 1 is known, that is, ⁇ 1 is known, so that the values of ⁇ 2 and ⁇ 3 can be obtained, that is, ⁇ 2 and ⁇ 3 expressed by ⁇ 1 can be obtained.
  • ⁇ 1 is fixed to a specific value, and then ⁇ 2 and ⁇ 3 are solved. If there is a solution, the motor is controlled to perform the grab operation. If there is no solution, the ⁇ 1 is changed with a certain gradient, and the solution is continued, if traversing all If there is no solution for ⁇ 1 , then the target is not within the solution space of the arm, and the position of the base of the arm needs to be moved to reposition the grip.
  • the operating portion 40 may be a mechanical gripper, that is, the robot arm grasps the operation target 50 by a mechanical gripper, thereby performing certain operations such as handling, assembly, and the like.
  • a servo mechanism may be disposed on the operation portion 40 to provide a certain preload force for fixing when the operation target 50 is grasped.
  • the operation unit 40 may be a welding device, a spraying device, a punching head or a hook, etc., so that after positioning the operation target 50, operations such as welding, spraying, punching, or hooking are realized.
  • the mechanical arm includes a plurality of pitch arms, and the ends of the plurality of pitch arms include an operation portion, and the plurality of pitch arms are connected end to end in the same vertical plane.
  • the plurality of pitch arms include a first pitch arm rotatably coupled to the base and a second pitch arm rotatably coupled to the first pitch arm.
  • Step S101 adjusting the first section arm and the second section arm to cause the distance measuring device built in the end of the second section arm to point to the operation position of the operation target, and acquire the first distance between the distance measuring device and the operation position.
  • Step S102 Acquire a first coordinate of the operation position in a vertical plane according to the first distance.
  • Step S103 controlling a plurality of pitch arm rotations of the robot arm, when the operation portion operates the operation position, an angle between adjacent ones of the plurality of pitch arms and a plurality of phase arms obtained according to the first coordinate The angle between the adjacent arms is the same.
  • the robot arm self-guided operation method converts the inverse solution operation of the three-dimensional space of the robot arm into a two-dimensional space operation by positioning the plurality of pitch arms of the robot arm and the operation position of the operation target in the same vertical plane. Simplify the calculation process, reduce the amount of calculations, and improve system processing performance. Moreover, compared with the prior art, the method of using visual or pan/tilt guidance can effectively save space and reduce hardware cost.
  • the first section arm and the second section arm of the step S101 are adjusted to point the distance measuring device built in the end of the second section arm to the operation position of the operation target, and obtain the first between the distance measuring device and the operation position.
  • the distance includes: determining that the operating position is in a vertical plane of the plurality of pitch arms; that is, adjusting the first pitch arm such that the mechanical arm is in the same vertical plane as the operation target, and then adjusting the second pitch arm and the first The angle of the arm is such that the distance measuring device positions the operating position of the operating target and thereby measures the first distance.
  • the method further comprises the step of determining that the ranging direction of the distance measuring device is perpendicular to the extending direction of the second pitch arm to form a first right angle, thereby facilitating calculation and improving the response speed.
  • the distance measuring device may be a laser distance measuring device or an infrared distance measuring device, which is fixed at the end of the second arm to emit a fixed angle of laser or infrared light with respect to the second arm.
  • the control device acquires the distance between the operation position of the operation target and the distance measuring device in real time.
  • the second arm rotates relative to the first arm.
  • the angle between the first arm and the second arm can be obtained by monitoring the angle of rotation of the steering gear or servo motor in the rotating joint.
  • the obtaining the first coordinate of the operation position in the vertical plane according to the first distance in the step S102 includes: acquiring the first angle between the first section arm and the second section arm, the first length of the first section arm, and the second a second length of the pitch arm; and acquiring the first coordinate according to the first distance, the first angle, the first length, the second length, and the first right angle.
  • the mechanical arm shown in FIG. 2 is used to locate the operation target of the operation target by using the distance measuring device, and the operation position of the operation target is calculated.
  • the operation position is the first coordinate of the operation target in the plane of the robot arm, and the detailed calculation process is the same as that in the first embodiment, and will not be described again.
  • the plurality of pitch arms of the control robot arm of the above step S103 are mutually rotated, so that when the operation portion operates the operation position of the operation target, the angle between the adjacent pitch arms of the plurality of pitch arms is obtained according to the first coordinate
  • the angle between the adjacent pitch arms of the plurality of pitch arms is identical, and specifically includes: when the mechanical arm includes four pitch arms, acquiring the second length of the second pitch arm, the third length of the third pitch arm, and the fourth And a fourth length of the pitch arm, and obtaining an angle between adjacent ones of the plurality of pitch arms according to the first coordinate, the second length, the third length, and the fourth length.
  • the matrix formula can be obtained to obtain the rotation of each of the plurality of pitch arms. angle. According to the number of series joint arms, the formula of the positional relationship matrix of the joint arms is adjusted.
  • the determination of the plane coordinate system and the detailed calculation process of the positioning grab operation target are the same as those of the first embodiment, and will not be described again.
  • the robot arm and the robot arm self-guided operation method by controlling the extending direction of the rotating shaft of the first pitch arm as the extending direction of the first pitch arm, and setting the distance measuring device at the end of the second pitch arm Positioning the ranging for the operation target, in the positioning and ranging process of the distance measuring device, rotating each of the arm arms of the robot arm into the same plane as the operation position of the operation target, thereby reducing the inverse solution operation of the three-dimensional space of the robot arm to two Dimensional space, reducing the amount of computation and improving system performance.
  • the method of using visual or pan/tilt guidance can effectively save space and reduce hardware cost.

Abstract

A mechanical arm and an operation method, said mechanical arm comprising a base (10), a plurality of joint arms, a ranging device (30) and a control device; the plurality of joint arms comprises a first joint arm (11) and a second joint arm (12), the plurality of joint arms being connected to each other in an end-to-end manner and provided in a same vertical plane; the ranging device (30) is provided at the end of the second joint arm (12), and the control device is configured to acquire, when the ranging device (30) locates an operation target of an operation portion (40), a first distance between the ranging device (30) and the operation position of the operation target (50) and an included angle between the first joint arm (11) and the second joint arm (12), calculate coordinates of the operation target (50) with respect to the base (10), and calculate a rotation angle of each of the plurality of joint arms according to the coordinates, thereby controlling rotation of each joint arm. The invention converts the inverse solution operation of a three-dimensional space of the mechanical arm into the operation of a two-dimensional space, simplifying the calculation process, reducing the operation amount, and improving the system processing performance.

Description

机械臂及机械臂自引导操作方法Robot arm and robot arm self-guided operation method
交叉引用cross reference
本申请引用于2017年11月14日提交的专利名称为“机械臂及机械臂自引导操作方法”的第201711122290.7号中国专利申请,其通过引用被全部并入本申请。The present application is hereby incorporated by reference in its entirety in its entirety in its entirety in its entirety in the the the the the the the the the the the the
技术领域Technical field
本发明涉及机械臂领域,特别涉及一种机械臂及机械臂自引导操作方法。The invention relates to the field of mechanical arms, and in particular to a self-guided operation method of a mechanical arm and a mechanical arm.
背景技术Background technique
无论是工业领域还是服务领域,机械臂的使用越来越普及。目前,大部分机械臂是单关节控制或者采用示教方式沿固定轨迹运行,这种方式操作繁琐并且只能在特定环境中使用。对于可引导定位的机械臂,目前多采用视觉或云台进行三维定位运算,定位和反解的运算量大且复杂,机械臂的整体占用空间也比较大。Whether in the industrial sector or in the service sector, the use of robotic arms is becoming more and more popular. At present, most of the robotic arms are single-joint control or teach along a fixed trajectory. This method is cumbersome and can only be used in certain environments. For the robotic arm that can be guided and positioned, the three-dimensional positioning operation is often adopted by the vision or the pan/tilt. The calculation and positioning of the positioning and the inverse solution are large and complicated, and the overall occupation space of the mechanical arm is also large.
发明内容Summary of the invention
本发明提供了一种降低运算量的机械臂及机械臂自引导操作方法。The invention provides a robot arm and a robot arm self-guided operation method for reducing the amount of calculation.
为了实现上述目的,本发明采用了如下技术方案:In order to achieve the above object, the present invention adopts the following technical solutions:
依据本发明的一个方面,提供了一种机械臂的自引导操作方法,机械臂包括多个节臂,多个节臂的末端包括操作部,多个节臂首尾相连位于同一竖直平面内,多个节臂包括与基座转动连接的第一节臂和与第一节臂转动连接的第二节臂,方法包括:调节第一节臂和第二节臂,以使内置在第二节臂末端的测距装置指向操作目标的操作位置,并获取测距装置与操作位置之间的第一距离;根据第一距离获取操作位置在竖直平面内的第一坐标;以及控制机械臂的多个节臂转动,在使得操作部对操作位置进行操作时,多个节臂中相邻节臂之间的角度与根据第一坐标获取的多个节臂中相邻节臂之间的角度一致。According to an aspect of the present invention, a self-guided operation method of a mechanical arm is provided. The mechanical arm includes a plurality of pitch arms, and the ends of the plurality of pitch arms include an operation portion, and the plurality of pitch arms are connected end to end in the same vertical plane. The plurality of pitch arms include a first pitch arm rotatably coupled to the base and a second pitch arm rotatably coupled to the first pitch arm, the method comprising: adjusting the first pitch arm and the second pitch arm to be built in the second section The distance measuring device at the end of the arm points to the operating position of the operation target, and acquires a first distance between the distance measuring device and the operating position; acquires the first coordinate of the operating position in the vertical plane according to the first distance; and controls the mechanical arm The plurality of pitch arms rotate, and when the operating portion operates the operating position, an angle between adjacent ones of the plurality of pitch arms and an angle between adjacent ones of the plurality of pitch arms acquired according to the first coordinate Consistent.
进一步地,调节第一节臂和第二节臂,以使内置在第二节臂末端的测距装置指向操作目标的操作位置,并获取测距装置与操作位置之间的第一距离包括:确定操作位置位于多个节臂的竖直平面内;以及确定竖直平面的平面坐标系。Further, adjusting the first section arm and the second section arm to point the distance measuring device built in the end of the second section arm to the operation position of the operation target, and acquiring the first distance between the distance measuring device and the operation position comprises: Determining that the operational position is in a vertical plane of the plurality of pitch arms; and determining a planar coordinate system of the vertical plane.
进一步地,方法还包括:确定测距装置的测距方向与第二节臂的延伸方向相垂直,形成第一直角。Further, the method further includes determining that the ranging direction of the distance measuring device is perpendicular to the extending direction of the second pitch arm to form a first right angle.
进一步地,根据第一距离获取操作位置在竖直平面的第一坐标,包括:获取第一节臂和第二节臂之间的第一角度、第一节臂的第一长度和第二节臂的第二长度;以及根据第一距离、第一角度、第一长度、第二长度以及第一直角,获取第一坐标。Further, acquiring the first coordinate of the operation position in the vertical plane according to the first distance comprises: acquiring a first angle between the first section arm and the second section arm, a first length of the first section arm, and a second section a second length of the arm; and obtaining the first coordinate based on the first distance, the first angle, the first length, the second length, and the first right angle.
进一步地,在使得操作部对操作位置进行操作时,多个节臂中相邻节臂之间的角度与根据第一坐标获取的多个节臂中相邻节臂之间的角度一致包括:当机械臂包括四个节臂时,获取第二节臂的第二长度、第三节臂的第三长度以及第四节臂的第四长度,以及根据第一坐标、第二长度、第三长度和第四长度获取多个节臂中相邻节臂之间的角度。Further, when the operating portion is caused to operate the operating position, an angle between adjacent ones of the plurality of pitch arms and an angle between adjacent ones of the plurality of pitch arms acquired according to the first coordinate include: When the robot arm includes four pitch arms, acquiring a second length of the second pitch arm, a third length of the third pitch arm, and a fourth length of the fourth pitch arm, and according to the first coordinate, the second length, and the third The length and the fourth length acquire an angle between adjacent ones of the plurality of pitch arms.
进一步地,根据第一坐标、第二长度、第三长度和第四长度获取多个节臂中相邻节臂之间的角度,包括:Further, acquiring an angle between adjacent ones of the plurality of pitch arms according to the first coordinate, the second length, the third length, and the fourth length includes:
Figure PCTCN2017118090-appb-000001
Figure PCTCN2017118090-appb-000001
其中,α 1=θ 1-90°,α 2=θ 2-90°,α 3=θ 3-90°;在使得机械臂对操作位置进行操作时,θ 1为第一节臂与相邻第二节臂之间的第二角度;θ 2为第二节臂与相邻第三节臂之间的第三角度;θ 3为第三节臂与第四节臂之间的第四角度;l 1为第二长度;l 2为第三长度;l 3为第四长度;(x,y)为第一坐标。 Where α 1 = θ 1 -90°, α 2 = θ 2 -90°, α 3 = θ 3 -90°; when the robot arm is operated on the operating position, θ 1 is the first arm and adjacent a second angle between the second section arms; θ 2 is a third angle between the second section arm and the adjacent third section arm; θ 3 is a fourth angle between the third section arm and the fourth section arm ; l 1 is the second length; l 2 is the third length; l 3 is the fourth length; (x, y) is the first coordinate.
本发明还提供了一种机械臂,用于前述的机械臂的自引导操作方法,机械臂包括多个节臂,多个节臂首尾相连位于同一竖直平面内,多个节臂包括与基座转动连接的第一节臂和与第一节臂转动连接的第二节臂,操作目标的操作位置位于竖直平面内,机械臂还包括测距装置和控制装置,测距装置内置在第二节臂末端,用于获取测距装置和操作目标的操作位置之间的第一距离;控制装置用于根据第一距离获取操作位置在竖直平面的第一坐标,并控制机械臂多个节臂转动,使得在机械臂对操作位置进行操作时,多个节臂中相邻节臂之间的角度与根据第一坐标获取的多个节臂中相邻节臂之间的角度一致。The invention also provides a mechanical arm for the self-guided operation method of the foregoing mechanical arm, the mechanical arm comprises a plurality of pitch arms, the plurality of pitch arms are connected end to end in the same vertical plane, and the plurality of pitch arms comprise a base The first section arm of the rotation connection and the second section arm rotatably connected with the first section arm, the operation position of the operation target is located in a vertical plane, the robot arm further comprises a distance measuring device and a control device, and the distance measuring device is built in the first a second arm end for obtaining a first distance between the distance measuring device and an operation position of the operation target; the control device is configured to acquire the first coordinate of the operation position in the vertical plane according to the first distance, and control the plurality of robot arms The pitch arm is rotated such that when the robot arm operates the operating position, an angle between adjacent ones of the plurality of pitch arms coincides with an angle between adjacent ones of the plurality of pitch arms acquired according to the first coordinate.
进一步地,测距装置的测距方向和第二节臂的延伸方向相互垂直成第一直角。Further, the ranging direction of the distance measuring device and the extending direction of the second pitch arm are perpendicular to each other at a first right angle.
进一步地,多个节臂首尾相连位于同一竖直平面内,包括:多个节臂之间通过转动关节相连,转动关节的转动轴向和通过转动关节相连的相邻两个节臂各自的延伸方向相互垂直,以使得多个节臂首尾相连位于同一竖直平面内。Further, the plurality of pitch arms are connected end to end in the same vertical plane, and the plurality of pitch arms are connected by a rotary joint, and the rotation axial direction of the rotary joint and the extension of the adjacent two joint arms connected by the rotary joint are respectively The directions are perpendicular to each other such that the plurality of pitch arms are connected end to end in the same vertical plane.
进一步地,测距装置还用于:确定操作位置位于多个节臂的竖直平面内;以及确定竖直平面的平面坐标系。Further, the distance measuring device is further configured to: determine that the operating position is located in a vertical plane of the plurality of pitch arms; and determine a planar coordinate system of the vertical plane.
进一步地,控制装置用于根据第一距离获取操作位置在竖直平面的第一坐标,包括:控制装置用于获取第一节臂和第二节臂之间的第一角度、第一节臂的第一长度和第二节臂的第二长度;以及控制装置用于根据第一距离、第一角度、第一长度、第二长度以及第一直角,获取第一坐标。Further, the control device is configured to acquire the first coordinate of the operation position in the vertical plane according to the first distance, comprising: the control device is configured to acquire the first angle between the first section arm and the second section arm, and the first section arm a first length and a second length of the second pitch arm; and control means for obtaining the first coordinate based on the first distance, the first angle, the first length, the second length, and the first right angle.
进一步地,控制装置用于控制机械臂多个节臂相互转动,使得在机械臂对操作位置进行操作时,多个节臂中相邻节臂之间的角度与根据第一坐标获取的多个节臂中相邻节臂之间的角度一致,包括:当机械臂包括四个节臂时,控制装置用于获取第二节臂的第二长度、第三节臂的第三长度以及第四节臂的第四长度,以及控制装置用于根据第一坐标、第二长度、第三长度和第四长度获取多个节臂中相邻节臂之间的角度。Further, the control device is configured to control the plurality of pitch arms of the mechanical arm to rotate with each other, so that when the mechanical arm operates the operating position, the angle between the adjacent pitch arms of the plurality of pitch arms is obtained according to the plurality of the first coordinate The angle between the adjacent pitch arms in the pitch arm is uniform, including: when the mechanical arm includes four pitch arms, the control device is configured to acquire the second length of the second pitch arm, the third length of the third pitch arm, and the fourth A fourth length of the pitch arm, and a control device for obtaining an angle between adjacent ones of the plurality of pitch arms based on the first coordinate, the second length, the third length, and the fourth length.
进一步地,控制装置用于根据第一坐标、第二长度、第三长度和第四长度获取多个节臂中相邻节臂之间的角度,包括:Further, the control device is configured to acquire an angle between adjacent ones of the plurality of pitch arms according to the first coordinate, the second length, the third length, and the fourth length, including:
Figure PCTCN2017118090-appb-000002
Figure PCTCN2017118090-appb-000002
其中,α 1=θ 1-90°,α 2=θ 2-90°,α 3=θ 3-90°;在使得机械臂对操作位置进行操作时,θ 1为第一节臂与相邻第二节臂之间的第二角度;θ 2为第二节臂与相邻第三节臂之间的第三角度;θ 3为第三节臂与第四节臂之间的第四角度;l 1为第二长度;l 2为第三长度;l 3为第四长度;(x,y)为第一坐标。 Where α 1 = θ 1 -90°, α 2 = θ 2 -90°, α 3 = θ 3 -90°; when the robot arm is operated on the operating position, θ 1 is the first arm and adjacent a second angle between the second section arms; θ 2 is a third angle between the second section arm and the adjacent third section arm; θ 3 is a fourth angle between the third section arm and the fourth section arm ; l 1 is the second length; l 2 is the third length; l 3 is the fourth length; (x, y) is the first coordinate.
进一步地,测距装置为激光测距装置、红外测距装置或超声测距装置。Further, the distance measuring device is a laser distance measuring device, an infrared distance measuring device or an ultrasonic distance measuring device.
进一步地,操作部为机械抓手、焊接头、打孔机头或挂钩。Further, the operating portion is a mechanical gripper, a welding head, a punching head or a hook.
综上所述,根据本发明的机械臂及机械臂自引导操作方法,通过使机械臂的多个节臂、操作目标的操作位置位于同一竖直平面下,将机械臂三维空间的反解运算转换成二维空间的运算,以简化计算过程,降低运算量,提高系统处理性能。而且相比现有技术中采用视觉或者云台引导的方式,能够有效节约空间,降低硬件成本。In summary, according to the self-guided operation method of the mechanical arm and the mechanical arm of the present invention, the inverse solution of the three-dimensional space of the mechanical arm is performed by positioning the plurality of pitch arms of the mechanical arm and the operation position of the operation target in the same vertical plane. Convert to a two-dimensional space operation to simplify the calculation process, reduce the amount of calculations, and improve system processing performance. Moreover, compared with the prior art, the method of using visual or pan/tilt guidance can effectively save space and reduce hardware cost.
附图说明DRAWINGS
构成本申请的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:The accompanying drawings, which are incorporated in the claims In the drawing:
图1是本发明的机械臂的结构示意图;Figure 1 is a schematic view showing the structure of a robot arm of the present invention;
图2是本发明的机械臂的测距装置定位操作目标的原理示意图;2 is a schematic view showing the principle of positioning operation of the distance measuring device of the mechanical arm of the present invention;
图3是本发明的机械臂抓取操作目标时的各个节臂的位置关系示意图;3 is a schematic view showing the positional relationship of each of the arm arms when the robot arm grasps the operation target of the present invention;
图4是图3的简化示意图;Figure 4 is a simplified schematic view of Figure 3;
图5是本发明的机械臂自引导操作方法的流程图。Fig. 5 is a flow chart showing the method of self-guided operation of the robot arm of the present invention.
具体实施方式Detailed ways
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明实施方式作进一步地详细描述。The embodiments of the present invention will be further described in detail below with reference to the accompanying drawings.
实施例一 Embodiment 1
如图1所示,本发明提供了一种机械臂,包括基座10和多个节臂,多个节臂首尾相连设置在同一竖直平面内,多个节臂包括与基座转动连接的第一节臂11和与第一节臂转动连接的第二节臂12,机械臂还包括测距装置30和控制装置,测距装置30固定设置在第二节臂12末端,用于获取所述测距装置和操作目标的操作位置之间的第一距离;控制装置用于根据第一距离获取操作位置在竖直平面的第一坐标,并控制机械臂多个节臂转动,使得在机械臂对操作目标的操作位置进行操作时,多个节臂中相邻节臂之间的角度与根据第一坐标获取的多个节臂中相邻节臂之间的角度一致。即控制装置用于在测距装置30定位操作部40的操作目标时,获取测距装置30与操作目标50的操作位置之间的第一距离和第一节臂11与第二节臂12之间的夹角,计算操作目标50相对基座10的坐标,即操作目标的操作位置在竖直平面的第一坐标,并根据第一坐标计算多个节臂中每个节臂的转动角度。控制装置进而根据相应的转动角度控制每个节臂转动。As shown in FIG. 1 , the present invention provides a mechanical arm including a base 10 and a plurality of pitch arms. The plurality of pitch arms are disposed end to end in the same vertical plane, and the plurality of pitch arms include a rotational connection with the base. a first section arm 11 and a second section arm 12 rotatably coupled to the first section arm, the robot arm further includes a distance measuring device 30 and a control device, and the distance measuring device 30 is fixedly disposed at the end of the second section arm 12 for acquiring Determining a first distance between the distance measuring device and an operating position of the operation target; the control device is configured to acquire the first coordinate of the operating position in the vertical plane according to the first distance, and control the rotation of the plurality of pitch arms of the mechanical arm, so that the mechanical When the arm operates the operation position of the operation target, an angle between adjacent ones of the plurality of pitch arms coincides with an angle between adjacent ones of the plurality of pitch arms acquired according to the first coordinate. That is, the control device is configured to acquire a first distance between the distance measuring device 30 and the operating position of the operation target 50 and the first pitch arm 11 and the second pitch arm 12 when the distance measuring device 30 positions the operation target of the operation portion 40. The angle between the operation target 50 relative to the base 10, that is, the first coordinate of the operation position of the operation target in the vertical plane, and the rotation angle of each of the plurality of pitch arms is calculated according to the first coordinate. The control device in turn controls the rotation of each of the pitch arms in accordance with the respective angle of rotation.
本发明通过使机械臂的多个节臂、操作目标的操作位置位于同一竖直平面下,将机械臂三维空间的反解运算转换成二维空间的运算,以简化计算过程,降低运算量,提高系统处理性能。而且相比现有技术中采用视觉或者云台引导的方式,能够有效节约空间,降低硬件成本。The invention converts the inverse solution operation of the three-dimensional space of the mechanical arm into the operation of the two-dimensional space by arranging the operation positions of the plurality of pitch arms and the operation target of the mechanical arm in the same vertical plane, thereby simplifying the calculation process and reducing the calculation amount. Improve system processing performance. Moreover, compared with the prior art, the method of using visual or pan/tilt guidance can effectively save space and reduce hardware cost.
优选地,测距装置30的测距方向和第二节臂12的延伸方向相互垂直成第一直角,方便计算,提高计算速度,从而提高整个机械臂的响应速度。Preferably, the distance measuring direction of the distance measuring device 30 and the extending direction of the second pitch arm 12 are perpendicular to each other at a first right angle, which facilitates calculation and increases the calculation speed, thereby improving the response speed of the entire mechanical arm.
具体地,多个节臂首尾相连位于同一竖直平面内,包括:多个节臂之间通过转动关节相连,转动关节的转动轴向和通过转动关节相连的相邻两个节臂各自的延伸方向相互垂直,以使得多个节臂首尾相连位于同一竖直平面内。更具体地,第一节臂11的转动 轴延伸方向为第一节臂的延伸方向,即第一节臂11的转动轴为自身轴线,运动时为绕轴线转动;第二节臂12及其后的转动轴的延伸方向垂直于第一节臂11的延伸方向,从而使其他节臂位于同一竖直平面内。Specifically, the plurality of pitch arms are connected end to end in the same vertical plane, and the plurality of pitch arms are connected by a rotary joint, and the rotation axial direction of the rotary joint and the extension of the adjacent two joint arms connected by the rotary joint are respectively The directions are perpendicular to each other such that the plurality of pitch arms are connected end to end in the same vertical plane. More specifically, the rotation axis of the first section arm 11 extends in the extending direction of the first section arm, that is, the rotation axis of the first section arm 11 is its own axis, and rotates about the axis when moving; the second section arm 12 and The extending direction of the rear rotating shaft is perpendicular to the extending direction of the first pitch arm 11, so that the other pitch arms are located in the same vertical plane.
优选地,测距装置30嵌入在第二节臂12内部,从而避免各节臂旋转时对测距装置30产生干涉。测距装置30可以采用激光测距装置或者红外测距装置,将测距装置30固定在第二节臂12上,其相对第二节臂12发射固定角度的激光或者红外光,并转动第一节臂11,从而将第二节臂12、测距装置30和其他的节臂移动到与操作目标50处于同一平面中。然后调节第二节臂12相对第一节臂11的夹角,即可将测距装置30发送的激光或者红外光定位对准操作目标50,进而可以测量测距装置30与操作目标50之间距离。控制装置与测距装置30进行通讯,获取其对操作目标50的第一距离,并获取此时第一节臂11与第二节臂12之间的夹角以便后续计算。在其他实施例中,测距装置30也可以采用超声波测距装置。Preferably, the distance measuring device 30 is embedded inside the second pitch arm 12 to avoid interference with the distance measuring device 30 when the pitch arms are rotated. The distance measuring device 30 can adopt a laser ranging device or an infrared ranging device, and fix the distance measuring device 30 on the second pitch arm 12, and emit a fixed angle of laser or infrared light with respect to the second pitch arm 12, and rotate the first The arm 11 is thereby moved to move the second pitch arm 12, the distance measuring device 30 and the other pitch arms into the same plane as the operation target 50. Then, the angle between the second section arm 12 and the first section arm 11 is adjusted, so that the laser or infrared light sent by the distance measuring device 30 can be positioned and aligned with the operation target 50, so that the distance between the distance measuring device 30 and the operation target 50 can be measured. distance. The control device communicates with the distance measuring device 30 to obtain its first distance to the operation target 50, and acquires an angle between the first pitch arm 11 and the second pitch arm 12 at this time for subsequent calculation. In other embodiments, the ranging device 30 can also employ an ultrasonic ranging device.
控制装置用于根据第一距离获取操作位置在竖直平面的第一坐标具体包括:控制装置用于获取第一节臂和第二节臂之间的第一角度、第一节臂的第一长度和第二节臂的第二长度;以及控制装置用于根据第一距离、第一角度、第一长度、第二长度以及第一直角,获取第一坐标。The acquiring, by the control device, the first coordinate of the operating position in the vertical plane according to the first distance comprises: the control device configured to acquire the first angle between the first pitch arm and the second pitch arm, and the first of the first pitch arm a length and a second length of the second pitch arm; and a control device for acquiring the first coordinate based on the first distance, the first angle, the first length, the second length, and the first right angle.
更具体地,结合图2来详细说明机械臂利用测距装置30定位操作目标的原理。在图2中,将操作目标50的操作位置和机械臂简化为点和线的关系,并确定平面坐标系,O点为平面坐标系原点,OP(第一节臂的延伸方向)为平面坐标系的Y轴,OS垂直于OP,并位于机械臂所在平面,作为平面坐标系的X轴。O点一般为第一节臂轴线与基座的交点。P点为第一节臂11与第二节臂12的铰接中心点,Q点为测距装置30,O’为操作目标50向机械臂的水平投影点。OP为机械臂坐标系的原点至第一节臂11末端的距离,为已知距离;PQ为第一节臂11末端至测距装置30的距离,也是已知距离;QR为操作目标50的操作位置与测距装置30的距离,可由测距装置30测量得出。OO’为操作目标50与机械臂所在平面的坐标系原点的垂直距离,RO’为操作目标50与机械臂所在平面的坐标系原点的水平距离,求出OO’和RO’,即可得知操作目标相对于坐标系原点的位置,完成操作目标50的定位。由图2可知,More specifically, the principle of the robot arm positioning the operation target using the distance measuring device 30 will be described in detail with reference to FIG. In FIG. 2, the operation position and the manipulator of the operation target 50 are simplified to the relationship between the point and the line, and the plane coordinate system is determined. The O point is the origin of the plane coordinate system, and the OP (the extension direction of the first section arm) is the plane coordinate. The Y axis of the system, the OS is perpendicular to the OP, and is located in the plane of the arm, as the X axis of the plane coordinate system. The point O is generally the intersection of the first arm axis and the base. Point P is the hinge center point of the first section arm 11 and the second section arm 12, and point Q is the distance measuring device 30, and O' is the horizontal projection point of the operation target 50 to the robot arm. OP is the distance from the origin of the robot arm coordinate system to the end of the first section arm 11 and is a known distance; PQ is the distance from the end of the first section arm 11 to the distance measuring device 30, which is also a known distance; QR is the operation target 50 The distance of the operating position from the distance measuring device 30 can be measured by the distance measuring device 30. OO' is the vertical distance between the operation target 50 and the origin of the coordinate system of the plane where the robot arm is located, and RO' is the horizontal distance between the operation target 50 and the origin of the coordinate system of the plane of the robot arm, and OO' and RO' are obtained, and it is known. The position of the operation target 50 is completed with respect to the position of the coordinate system origin. As can be seen from Figure 2,
Figure PCTCN2017118090-appb-000003
Figure PCTCN2017118090-appb-000003
Figure PCTCN2017118090-appb-000004
Figure PCTCN2017118090-appb-000004
∠OPR=∠OPQ-∠QPR∠OPR=∠OPQ-∠QPR
PO′=PR·cos∠OPRPO'=PR·cos∠OPR
OS=O′R=PR·sin∠OPROS=O'R=PR·sin∠OPR
SR=OO′=OP-PO′SR=OO'=OP-PO'
控制装置使用前已经存储好已知条件,并实时获取测距装置30工作时的相应数据,利用上述计算公式,得出操作目标50在机械臂所在平面内的第一坐标为(RO’,OO’)。The control device has stored the known conditions before use, and obtains the corresponding data of the distance measuring device 30 in real time. Using the above calculation formula, the first coordinate of the operation target 50 in the plane of the robot arm is obtained (RO', OO ').
其中,控制装置用于控制机械臂多个节臂相互转动,使得在机械臂对操作目标的操作位置进行操作时,多个节臂中相邻节臂之间的角度与根据第一坐标获取的多个节臂中相邻节臂之间的角度一致,具体包括:当机械臂包括四个节臂时,控制装置用于获取第二节臂的第二长度、第三节臂的第三长度以及第四节臂的第四长度,以及控制装置用于根据第一坐标、第二长度、第三长度和第四长度获取多个节臂中相邻节臂之间的角度。Wherein, the control device is configured to control the plurality of pitch arms of the robot arm to rotate with each other, so that when the mechanical arm operates the operation position of the operation target, the angle between the adjacent pitch arms of the plurality of pitch arms is obtained according to the first coordinate The angle between the adjacent pitch arms of the plurality of pitch arms is identical, and specifically includes: when the mechanical arm includes four pitch arms, the control device is configured to acquire the second length of the second pitch arm and the third length of the third pitch arm And a fourth length of the fourth pitch arm, and the control device is configured to obtain an angle between the adjacent pitch arms of the plurality of pitch arms according to the first coordinate, the second length, the third length, and the fourth length.
也即在本发明优选的实施例中,机械臂包括四个节臂。结合图3所示,机械臂还包括与第二节臂12转动连接的第三节臂13和与第三节臂13转动连接的第四节臂14,其中,第三节臂13、第四节臂14的转动轴的延伸方向垂直于第一节臂的延伸方向,也即第二节臂12、第三节臂13和第四节臂14的转动轴均垂直于第一节臂11,从而可以保证第二、第三、第四节臂与第一节臂11始终位于同一平面内。优选地,在该机械臂中,具有转动连接关系的节臂通过转动关节连接,且转动关节通过舵机或者伺服电机驱动控制。具体地,基座10与第一节臂11通过转动关节21连接,第一节臂11与第二节臂12通过转动关节22连接,第二节臂12与第三节臂13通过转动关节23连接,第三节臂13与第四节臂14通过转动关节24连接,第四节臂14与操作部40也可以通过转动关节25连接。单个转动关节的转动采取独立的控制方式,即每个转动关节独立转动,带动与之连接的节臂独立运动,从而避免由于各个节臂运动的相互干涉,影响机械臂的操作。控制装置发出转动指令,包括转动方向和转动角度对每个转动关节的运动进行独立控制。That is, in a preferred embodiment of the invention, the robot arm includes four pitch arms. As shown in FIG. 3, the mechanical arm further includes a third section arm 13 rotatably coupled to the second section arm 12 and a fourth section arm 14 rotatably coupled to the third section arm 13, wherein the third section arm 13 and the fourth section The extending direction of the rotating shaft of the pitch arm 14 is perpendicular to the extending direction of the first pitch arm, that is, the rotating axes of the second pitch arm 12, the third pitch arm 13 and the fourth pitch arm 14 are perpendicular to the first pitch arm 11, Thereby, it can be ensured that the second, third and fourth section arms and the first section arm 11 are always in the same plane. Preferably, in the robot arm, the pitch arms having the rotational connection relationship are connected by the rotary joint, and the rotary joint is driven and controlled by the steering gear or the servo motor. Specifically, the base 10 and the first pitch arm 11 are connected by a rotary joint 21, the first pitch arm 11 and the second pitch arm 12 are connected by a rotary joint 22, and the second pitch arm 12 and the third pitch arm 13 pass the rotary joint 23 The third arm 13 and the fourth arm 14 are connected by a rotary joint 24, and the fourth arm 14 and the operating portion 40 may be connected by a rotary joint 25. The rotation of the single rotating joint adopts an independent control mode, that is, each rotating joint rotates independently, and the joint arm connected thereto is driven to move independently, thereby avoiding the mutual interference of the motion of each joint arm and affecting the operation of the mechanical arm. The control device issues a rotation command including a rotation direction and a rotation angle to independently control the movement of each of the rotary joints.
机械臂确定了操作目标50在机械臂所在平面内的第一坐标,对操作目标50执行操作动作。此时各个节臂之间的位置关系如图3和图4所示。The robot arm determines the first coordinate of the operation target 50 in the plane of the robot arm, and performs an operation action on the operation target 50. At this time, the positional relationship between the respective arm arms is as shown in FIGS. 3 and 4.
结合图4所示,A、B和C分别为转动关节22、23和24,在操作部40抓取操作目标50时,可将操作目标50简化为点D。根据图4所示的位置关系,利用三维空间中的D-H模型来处理链式机械臂的相对关系,这里在二维平面上,采用D-H模型的思想来处理坐标关系,可知:As shown in FIG. 4, A, B, and C are the rotary joints 22, 23, and 24, respectively, and when the operation portion 40 grasps the operation target 50, the operation target 50 can be simplified to the point D. According to the positional relationship shown in Fig. 4, the relative relationship of the chain manipulators is processed by the D-H model in the three-dimensional space. Here, on the two-dimensional plane, the D-H model is used to process the coordinate relationship, and it is known that:
D在C坐标系中的坐标为(l 3cosα 3,l 3sinα 3); The coordinate of D in the C coordinate system is (l 3 cosα 3 , l 3 sinα 3 );
C处坐标系相对B处坐标系的齐次变换矩阵为
Figure PCTCN2017118090-appb-000005
The homogeneous transformation matrix of the coordinate system at C relative to the coordinate system at B is
Figure PCTCN2017118090-appb-000005
B处坐标系相对A处坐标系的齐次变换矩阵为
Figure PCTCN2017118090-appb-000006
The homogeneous transformation matrix of the coordinate system at B relative to the coordinate system at A is
Figure PCTCN2017118090-appb-000006
最终,得到D相对于A的坐标为:Finally, the coordinates of D relative to A are:
Figure PCTCN2017118090-appb-000007
Figure PCTCN2017118090-appb-000007
其中,α 1=θ 1-90°,α 2=θ 2-90°,α 3=θ 3-90°;θ 1为第二节臂与第一节臂之间第二角度;θ 2为第三节臂与第二节臂之间的第三角度;θ 3为第四节臂与第三节臂之间的第四角度;l 1为第二节臂的长度;l 2为第三节臂的长度;l 3为第四节臂的长度;(x,y)为机械臂定位并计算获取的操作目标50在机械臂所在平面内的第一坐标。在获得操作目标50的第一坐标(x,y)的后,求解上述公式,确定第二节臂相对第一节臂转动的第二角度θ 1,第三节臂相对第二节臂转动的第三角度θ 2,以及第四节臂相对第三节臂转动的第四角度θ 3。通过转动关节内的舵机或伺服电机,控制每个转动关节转过相应的角度,将操作部40移动至操作目标50处。 Where α 1 = θ 1 -90°, α 2 = θ 2 -90°, α 3 = θ 3 -90°; θ 1 is the second angle between the second pitch arm and the first pitch arm; θ 2 is a third angle between the third section arm and the second section arm; θ 3 is a fourth angle between the fourth section arm and the third section arm; l 1 is the length of the second section arm; l 2 is the third The length of the pitch arm; l 3 is the length of the fourth pitch arm; (x, y) is the mechanical arm positioning and calculates the first coordinate of the acquired operational target 50 in the plane of the mechanical arm. After obtaining the first coordinate (x, y) of the operation target 50, the above formula is solved to determine a second angle θ 1 of the second section arm relative to the rotation of the first section arm, and the third section arm is rotated relative to the second section arm The third angle θ 2 and the fourth angle θ 3 of the fourth pitch arm relative to the third pitch arm rotation. By rotating the steering gear or the servo motor in the joint, each of the rotating joints is controlled to rotate through a corresponding angle, and the operating portion 40 is moved to the operation target 50.
上述矩阵中包含三个未知变量,可假定α 1已知,即θ 1已知,从而可得到α 2和α 3的值,即,可以得到用θ 1来表示的θ 2和θ 3,在实际操作时,将θ 1固定为一个特定值,然后解算θ 2和θ 3,如果存在解则控制电机进行抓取工作,如果无解则以一定梯度更改θ 1,继续求解,如果遍历所有θ 1都无解,则目标不在机械臂的解空间范围之内,需要移动机械臂基座的位置,重新定位抓取。 The above matrix contains three unknown variables, and it can be assumed that α 1 is known, that is, θ 1 is known, so that the values of α 2 and α 3 can be obtained, that is, θ 2 and θ 3 expressed by θ 1 can be obtained. In actual operation, θ 1 is fixed to a specific value, and then θ 2 and θ 3 are solved. If there is a solution, the motor is controlled to perform the grab operation. If there is no solution, the θ 1 is changed with a certain gradient, and the solution is continued, if traversing all If there is no solution for θ 1 , then the target is not within the solution space of the arm, and the position of the base of the arm needs to be moved to reposition the grip.
在实际操作过程中,当机械臂多于4个节臂时,采用类似于上述操作,将某几个节 臂的角度假定为已知,从而用来表示其他的未知角度,在计算时,采用遍历的方式,从而得到有效解。In the actual operation, when the robot arm has more than 4 pitch arms, the angle of some of the pitch arms is assumed to be known similarly to the above operation, and is used to represent other unknown angles. Traversing the way to get an effective solution.
一般地,操作部40可以为机械抓手,即机械臂通过机械抓手抓取操作目标50,从而进行一定的操作,如搬运,装配等。操作部40上可以设置伺服机构,在抓取操作目标50时提供一定的预紧力进行固定。操作部40也可以为焊接装置、喷涂装置、打孔机头或挂钩等,从而在定位操作目标50后,实现焊接、喷涂、打孔或者钩挂等操作。Generally, the operating portion 40 may be a mechanical gripper, that is, the robot arm grasps the operation target 50 by a mechanical gripper, thereby performing certain operations such as handling, assembly, and the like. A servo mechanism may be disposed on the operation portion 40 to provide a certain preload force for fixing when the operation target 50 is grasped. The operation unit 40 may be a welding device, a spraying device, a punching head or a hook, etc., so that after positioning the operation target 50, operations such as welding, spraying, punching, or hooking are realized.
实施例二 Embodiment 2
图5为机械臂自引导操作方法的流程图,结合图1至5所示,机械臂包括多个节臂,多个节臂的末端包括操作部,多个节臂首尾相连位于同一竖直平面内,多个节臂包括与基座转动连接的第一节臂和与第一节臂转动连接的第二节臂。该方法包括以下步骤:5 is a flow chart of a self-guided operation method of a robot arm. As shown in FIG. 1 to FIG. 5, the mechanical arm includes a plurality of pitch arms, and the ends of the plurality of pitch arms include an operation portion, and the plurality of pitch arms are connected end to end in the same vertical plane. The plurality of pitch arms include a first pitch arm rotatably coupled to the base and a second pitch arm rotatably coupled to the first pitch arm. The method includes the following steps:
步骤S101,调节第一节臂和第二节臂,以使内置在第二节臂末端的测距装置指向操作目标的操作位置,并获取测距装置与操作位置之间的第一距离。Step S101, adjusting the first section arm and the second section arm to cause the distance measuring device built in the end of the second section arm to point to the operation position of the operation target, and acquire the first distance between the distance measuring device and the operation position.
步骤S102,根据第一距离获取操作位置在竖直平面内的第一坐标。Step S102: Acquire a first coordinate of the operation position in a vertical plane according to the first distance.
步骤S103,控制机械臂的多个节臂转动,在使得操作部对操作位置进行操作时,多个节臂中相邻节臂之间的角度与根据第一坐标获取的多个节臂中相邻节臂之间的角度一致。Step S103, controlling a plurality of pitch arm rotations of the robot arm, when the operation portion operates the operation position, an angle between adjacent ones of the plurality of pitch arms and a plurality of phase arms obtained according to the first coordinate The angle between the adjacent arms is the same.
即本发明的机械臂自引导操作方法通过使机械臂的多个节臂、操作目标的操作位置位于同一竖直平面下,将机械臂三维空间的反解运算转换成二维空间的运算,以简化计算过程,降低运算量,提高系统处理性能。而且相比现有技术中采用视觉或者云台引导的方式,能够有效节约空间,降低硬件成本。That is, the robot arm self-guided operation method converts the inverse solution operation of the three-dimensional space of the robot arm into a two-dimensional space operation by positioning the plurality of pitch arms of the robot arm and the operation position of the operation target in the same vertical plane. Simplify the calculation process, reduce the amount of calculations, and improve system processing performance. Moreover, compared with the prior art, the method of using visual or pan/tilt guidance can effectively save space and reduce hardware cost.
具体地,上述步骤S101的调节第一节臂和第二节臂,以使内置在第二节臂末端的测距装置指向操作目标的操作位置,并获取测距装置与操作位置之间的第一距离包括:确定操作位置位于多个节臂的竖直平面内;即通过调节第一节臂,从而使机械臂与操作目标位于同一竖直平面内,然后通过调节第二节臂与第一节臂的角度,从而使测距装置定位操作目标的操作位置,并进而测量出第一距离。Specifically, the first section arm and the second section arm of the step S101 are adjusted to point the distance measuring device built in the end of the second section arm to the operation position of the operation target, and obtain the first between the distance measuring device and the operation position. The distance includes: determining that the operating position is in a vertical plane of the plurality of pitch arms; that is, adjusting the first pitch arm such that the mechanical arm is in the same vertical plane as the operation target, and then adjusting the second pitch arm and the first The angle of the arm is such that the distance measuring device positions the operating position of the operating target and thereby measures the first distance.
优选地,该方法还包括步骤:确定测距装置的测距方向与第二节臂的延伸方向相垂直,形成第一直角,从而便于计算,提高响应速度。Preferably, the method further comprises the step of determining that the ranging direction of the distance measuring device is perpendicular to the extending direction of the second pitch arm to form a first right angle, thereby facilitating calculation and improving the response speed.
测距装置可以采用激光测距装置或红外测距装置,将其固定在第二节臂的末端,使其相对第二节臂发射固定角度的激光或红外光。控制装置实时获取操作目标的操作位置与测距装置之间的距离。在定位操作目标过程中,第二节臂相对第一节臂发生转动。通 过监测转动关节中舵机或伺服电机的转动角度,可以获取第一节臂与第二节臂之间的角度。The distance measuring device may be a laser distance measuring device or an infrared distance measuring device, which is fixed at the end of the second arm to emit a fixed angle of laser or infrared light with respect to the second arm. The control device acquires the distance between the operation position of the operation target and the distance measuring device in real time. During the positioning of the operating target, the second arm rotates relative to the first arm. The angle between the first arm and the second arm can be obtained by monitoring the angle of rotation of the steering gear or servo motor in the rotating joint.
上述步骤S102的根据第一距离获取操作位置在竖直平面的第一坐标具体包括:获取第一节臂和第二节臂之间的第一角度、第一节臂的第一长度和第二节臂的第二长度;以及根据第一距离、第一角度、第一长度、第二长度以及第一直角,获取第一坐标。根据以上的已知参数,结合图2所示的机械臂利用测距装置定位操作目标的原理图,计算获取操作目标的操作位置。该操作位置即为操作目标在机械臂所在平面内的第一坐标,详细的计算过程与实施例一相同,不再赘述。The obtaining the first coordinate of the operation position in the vertical plane according to the first distance in the step S102 includes: acquiring the first angle between the first section arm and the second section arm, the first length of the first section arm, and the second a second length of the pitch arm; and acquiring the first coordinate according to the first distance, the first angle, the first length, the second length, and the first right angle. According to the above known parameters, the mechanical arm shown in FIG. 2 is used to locate the operation target of the operation target by using the distance measuring device, and the operation position of the operation target is calculated. The operation position is the first coordinate of the operation target in the plane of the robot arm, and the detailed calculation process is the same as that in the first embodiment, and will not be described again.
进一步地,上述步骤S103的控制机械臂多个节臂相互转动,使得操作部在对操作目标的操作位置进行操作时,多个节臂中相邻节臂之间的角度与根据第一坐标获取的多个节臂中相邻节臂之间的角度一致,具体包括:当机械臂包括四个节臂时,获取第二节臂的第二长度、第三节臂的第三长度以及第四节臂的第四长度,以及根据第一坐标、第二长度、第三长度和第四长度获取多个节臂中相邻节臂之间的角度。Further, the plurality of pitch arms of the control robot arm of the above step S103 are mutually rotated, so that when the operation portion operates the operation position of the operation target, the angle between the adjacent pitch arms of the plurality of pitch arms is obtained according to the first coordinate The angle between the adjacent pitch arms of the plurality of pitch arms is identical, and specifically includes: when the mechanical arm includes four pitch arms, acquiring the second length of the second pitch arm, the third length of the third pitch arm, and the fourth And a fourth length of the pitch arm, and obtaining an angle between adjacent ones of the plurality of pitch arms according to the first coordinate, the second length, the third length, and the fourth length.
结合图3和图4所示,根据机械臂抓取操作目标时各个节臂位置关系的公式,在确定操作目标的操作位置后,求解矩阵公式可获取多个节臂中每个节臂的转动角度。根据串联节臂个数,调整节臂位置关系矩阵公式。在第二实施例中,平面坐标系的确定、以及定位抓取操作目标的详细计算过程均与第一实施例相同,不再赘述。As shown in FIG. 3 and FIG. 4, according to the formula of the positional relationship of each joint arm when the robot arm grasps the operation target, after determining the operation position of the operation target, the matrix formula can be obtained to obtain the rotation of each of the plurality of pitch arms. angle. According to the number of series joint arms, the formula of the positional relationship matrix of the joint arms is adjusted. In the second embodiment, the determination of the plane coordinate system and the detailed calculation process of the positioning grab operation target are the same as those of the first embodiment, and will not be described again.
综上所述,根据本发明的机械臂及机械臂自引导操作方法,通过控制第一节臂的转动轴延伸方向为第一节臂的延伸方向,并在第二节臂末端设置测距装置对操作目标定位测距,在测距装置定位测距过程中,将机械臂的各个节臂转动到与操作目标的操作位置处于同一平面中,从而将机械臂三维空间的反解运算降低到二维空间,降低运算量,提高系统性能。而且相比现有技术中采用视觉或者云台引导的方式,能够有效节约空间,降低硬件成本。In summary, the robot arm and the robot arm self-guided operation method according to the present invention, by controlling the extending direction of the rotating shaft of the first pitch arm as the extending direction of the first pitch arm, and setting the distance measuring device at the end of the second pitch arm Positioning the ranging for the operation target, in the positioning and ranging process of the distance measuring device, rotating each of the arm arms of the robot arm into the same plane as the operation position of the operation target, thereby reducing the inverse solution operation of the three-dimensional space of the robot arm to two Dimensional space, reducing the amount of computation and improving system performance. Moreover, compared with the prior art, the method of using visual or pan/tilt guidance can effectively save space and reduce hardware cost.
以上所述,仅为本发明的具体实施方式,在本发明的上述教导下,本领域技术人员可以在上述实施例的基础上进行其他的改进或变形。本领域技术人员应该明白,上述的具体描述只是更好的解释本发明的目的,本发明的保护范围应以权利要求的保护范围为准。The above is only the embodiment of the present invention, and other improvements or modifications may be made by those skilled in the art based on the above embodiments. It should be understood by those skilled in the art that the foregoing detailed description of the invention is intended to provide a better understanding of the scope of the invention.

Claims (10)

  1. 一种机械臂的自引导操作方法,所述机械臂包括多个节臂,所述多个节臂的末端包括操作部,其特征在于,所述多个节臂首尾相连位于同一竖直平面内,所述多个节臂包括与基座转动连接的第一节臂和与所述第一节臂转动连接的第二节臂,所述方法包括:A self-guided operation method of a mechanical arm, the mechanical arm includes a plurality of pitch arms, and an end of the plurality of pitch arms includes an operation portion, wherein the plurality of pitch arms are connected end to end in the same vertical plane The plurality of pitch arms include a first pitch arm rotatably coupled to the base and a second pitch arm rotatably coupled to the first pitch arm, the method comprising:
    调节所述第一节臂和所述第二节臂,以使内置在第二节臂末端的测距装置指向操作目标的操作位置,并获取所述测距装置与所述操作位置之间的第一距离;Adjusting the first pitch arm and the second pitch arm to point a distance measuring device built in the end of the second pitch arm to an operation position of the operation target, and acquiring between the distance measuring device and the operation position First distance
    根据所述第一距离获取所述操作位置在所述竖直平面内的第一坐标;以及Obtaining, according to the first distance, a first coordinate of the operating position in the vertical plane;
    控制所述机械臂的多个节臂转动,在使得所述操作部对所述操作位置进行操作时,所述多个节臂中相邻节臂之间的角度与根据所述第一坐标获取的所述多个节臂中相邻节臂之间的角度一致。Controlling a plurality of pitch arm rotations of the robot arm, and when the operation portion operates the operation position, an angle between adjacent ones of the plurality of pitch arms is obtained according to the first coordinate The angle between adjacent ones of the plurality of pitch arms is uniform.
  2. 根据权利要求1所述的机械臂的自引导操作方法,其特征在于,所述方法还包括:The self-guided operation method of the mechanical arm according to claim 1, wherein the method further comprises:
    确定所述竖直平面的平面坐标系。A planar coordinate system of the vertical plane is determined.
  3. 根据权利要求1所述的机械臂的自引导操作方法,其特征在于,所述方法还包括:The self-guided operation method of the mechanical arm according to claim 1, wherein the method further comprises:
    确定所述测距装置的测距方向与所述第二节臂的延伸方向相垂直,形成第一直角。It is determined that the ranging direction of the distance measuring device is perpendicular to the extending direction of the second pitch arm to form a first right angle.
  4. 根据权利要求3所述的机械臂的自引导操作方法,其特征在于,所述根据所述第一距离获取所述操作位置在所述竖直平面的第一坐标,包括:The self-guided operation method of the robot arm according to claim 3, wherein the acquiring the first coordinate of the operation position in the vertical plane according to the first distance comprises:
    获取第一节臂和所述第二节臂之间的第一角度、所述第一节臂的第一长度和所述第二节臂的第二长度;以及Obtaining a first angle between the first pitch arm and the second pitch arm, a first length of the first pitch arm, and a second length of the second pitch arm;
    根据所述第一距离、所述第一角度、所述第一长度、所述第二长度以及所述第一直角,获取所述第一坐标。And acquiring the first coordinate according to the first distance, the first angle, the first length, the second length, and the first right angle.
  5. 根据权利要求1所述的机械臂的自引导操作方法,其特征在于,所述在使得所述操作部对所述操作位置进行操作时,所述多个节臂中相邻节臂之间的角度与根据所述第一坐标获取的所述多个节臂中相邻节臂之间的角度一致包括:The self-guided operation method of the robot arm according to claim 1, wherein the operation between the adjacent arm portions of the plurality of pitch arms is performed when the operation portion is operated on the operation position The angle coincides with an angle between adjacent ones of the plurality of pitch arms acquired according to the first coordinate, including:
    当所述机械臂包括四个节臂时,获取第二节臂的第二长度、第三节臂的第三长度以及第四节臂的第四长度,以及When the mechanical arm includes four pitch arms, obtaining a second length of the second pitch arm, a third length of the third pitch arm, and a fourth length of the fourth pitch arm, and
    根据所述第一坐标、所述第二长度、所述第三长度和所述第四长度获取所述多个节臂中相邻节臂之间的角度。Obtaining an angle between adjacent ones of the plurality of pitch arms according to the first coordinate, the second length, the third length, and the fourth length.
  6. 根据权利要求5所述的机械臂的自引导操作方法,其特征在于,所述根据所述第一坐标、所述第二长度、所述第三长度和所述第四长度获取所述多个节臂中相邻节臂之间的角度,包括:The self-guided operation method of a robot arm according to claim 5, wherein the acquiring the plurality of the first coordinates, the second length, the third length, and the fourth length The angle between adjacent arms in the section arm, including:
    Figure PCTCN2017118090-appb-100001
    Figure PCTCN2017118090-appb-100001
    其中,α 1=θ 1-90°,α 2=θ 2-90°,α 3=θ 3-90°;在使得所述机械臂对所述操作位置进行操作时,θ 1为所述第一节臂与相邻所述第二节臂之间的第二角度;θ 2为所述第二节臂与相邻所述第三节臂之间的第三角度;θ 3为所述第三节臂与所述第四节臂之间的第四角度;l 1为所述第二长度;l 2为所述第三长度;l 3为所述第四长度;(x,y)为所述第一坐标。 Wherein α 11 -90°, α 22 -90°, α 33 -90°; when the mechanical arm is operated on the operating position, θ 1 is the first a second angle between the one arm and the adjacent second arm; θ 2 is a third angle between the second arm and the adjacent third arm; θ 3 is the a fourth angle between the three-section arm and the fourth-section arm; l 1 is the second length; l 2 is the third length; 13 is the fourth length; (x, y) is The first coordinate.
  7. 一种机械臂,用于权利要求1至6中任一项所述的机械臂的自引导操作方法,所述机械臂包括多个节臂,其特征在于,所述多个节臂首尾相连位于同一竖直平面内,所述多个节臂包括与基座转动连接的第一节臂和与所述第一节臂转动连接的第二节臂,操作目标的操作位置位于所述竖直平面内,所述机械臂还包括测距装置和控制装置,A robot arm for use in a self-guided operation method of a robot arm according to any one of claims 1 to 6, wherein the robot arm includes a plurality of pitch arms, wherein the plurality of pitch arms are end to end connected In the same vertical plane, the plurality of pitch arms include a first pitch arm rotatably coupled to the base and a second pitch arm rotatably coupled to the first pitch arm, the operational position of the operation target being located in the vertical plane The mechanical arm further includes a distance measuring device and a control device.
    所述测距装置内置在第二节臂末端,用于获取所述测距装置和操作目标的操作位置之间的第一距离;The distance measuring device is built in an end of the second section arm for acquiring a first distance between the distance measuring device and an operating position of the operation target;
    所述控制装置用于根据第一距离获取所述操作位置在所述竖直平面的第一坐标,并控制所述机械臂多个节臂转动,使得在所述机械臂对所述操作位置进行操作时,所述多个节臂中相邻节臂之间的角度与根据第一坐标获取的多个节臂中相邻节臂之间的角度一致。The control device is configured to acquire a first coordinate of the operating position in the vertical plane according to a first distance, and control a plurality of pitch arm rotations of the mechanical arm, so that the mechanical arm performs the operating position on the operating arm In operation, an angle between adjacent ones of the plurality of pitch arms coincides with an angle between adjacent ones of the plurality of pitch arms acquired according to the first coordinate.
  8. 根据权利要求7所述的机械臂,其特征在于,所述测距装置的测距方向和所述第二节臂的延伸方向相互垂直成第一直角。The robot arm according to claim 7, wherein the distance measuring direction of the distance measuring device and the extending direction of the second pitch arm are perpendicular to each other at a first right angle.
  9. 根据权利要求7所述的机械臂,其特征在于,所述多个节臂首尾相连位于同一竖直平面内,包括:The robot arm according to claim 7, wherein the plurality of pitch arms are connected end to end in the same vertical plane, comprising:
    所述多个节臂之间通过转动关节相连,所述转动关节的转动轴向和通过所述转动关节相连的相邻两个节臂各自的延伸方向相互垂直,以使得所述多个节臂首 尾相连位于同一竖直平面内。The plurality of pitch arms are connected by a rotary joint, and a rotation axis of the rotary joint and an extending direction of each of the adjacent two joint arms connected through the rotary joint are perpendicular to each other, so that the plurality of pitch arms End to end in the same vertical plane.
  10. 根据权利要求7所述的机械臂,其特征在于,The robot arm according to claim 7, wherein
    所述控制装置用于根据第一距离获取所述操作位置在所述竖直平面的第一坐标,包括:The control device is configured to acquire the first coordinate of the operating position in the vertical plane according to the first distance, including:
    所述控制装置用于获取第一节臂和所述第二节臂之间的第一角度、所述第一节臂的第一长度和所述第二节臂的第二长度;以及The control device is configured to acquire a first angle between the first pitch arm and the second pitch arm, a first length of the first pitch arm, and a second length of the second pitch arm;
    所述控制装置用于根据所述第一距离、所述第一角度、所述第一长度、所述第二长度以及所述第一直角,获取所述第一坐标。The control device is configured to acquire the first coordinate according to the first distance, the first angle, the first length, the second length, and the first right angle.
PCT/CN2017/118090 2017-11-14 2017-12-22 Mechanical arm and self-guiding operation method for mechanical arm WO2019095506A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201711122290.7A CN108098746B (en) 2017-11-14 2017-11-14 Mechanical arm and mechanical arm bootstrap operating method
CN201711122290.7 2017-11-14

Publications (1)

Publication Number Publication Date
WO2019095506A1 true WO2019095506A1 (en) 2019-05-23

Family

ID=62207257

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2017/118090 WO2019095506A1 (en) 2017-11-14 2017-12-22 Mechanical arm and self-guiding operation method for mechanical arm

Country Status (2)

Country Link
CN (1) CN108098746B (en)
WO (1) WO2019095506A1 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110497391B (en) * 2019-09-04 2020-11-03 湖南三一快而居住宅工业有限公司 Mechanical arm demonstration method and mechanical arm demonstration device
CN114669864B (en) * 2022-05-26 2022-08-19 江苏长江智能制造研究院有限责任公司 Welding manipulator with adjustable welding angle

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010276447A (en) * 2009-05-28 2010-12-09 Seiko Epson Corp Position measuring apparatus, position measuring method and robot system
CN203266633U (en) * 2013-05-21 2013-11-06 洛阳理工学院 Space coordinate positioning grabbing mechanical arm
KR20150080050A (en) * 2013-12-30 2015-07-09 전자부품연구원 Collision sensing apparatus of articulated robot and method using the same
CN105798909A (en) * 2016-04-29 2016-07-27 上海交通大学 Calibration system and method of zero position of robot based on laser and vision
CN205466320U (en) * 2016-01-27 2016-08-17 华南理工大学 Intelligent machine hand based on many camera lenses
CN105856210A (en) * 2016-05-04 2016-08-17 沧州致胜机器人科技有限公司 Vacuum sucker loading and unloading device and method for laser cutting robot

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5451219B2 (en) * 2009-07-06 2014-03-26 キヤノン株式会社 Parts assembly method

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010276447A (en) * 2009-05-28 2010-12-09 Seiko Epson Corp Position measuring apparatus, position measuring method and robot system
CN203266633U (en) * 2013-05-21 2013-11-06 洛阳理工学院 Space coordinate positioning grabbing mechanical arm
KR20150080050A (en) * 2013-12-30 2015-07-09 전자부품연구원 Collision sensing apparatus of articulated robot and method using the same
CN205466320U (en) * 2016-01-27 2016-08-17 华南理工大学 Intelligent machine hand based on many camera lenses
CN105798909A (en) * 2016-04-29 2016-07-27 上海交通大学 Calibration system and method of zero position of robot based on laser and vision
CN105856210A (en) * 2016-05-04 2016-08-17 沧州致胜机器人科技有限公司 Vacuum sucker loading and unloading device and method for laser cutting robot

Also Published As

Publication number Publication date
CN108098746A (en) 2018-06-01
CN108098746B (en) 2019-08-20

Similar Documents

Publication Publication Date Title
US9221176B2 (en) Robot system and method for controlling the same
JP2019014031A5 (en) Robot controller, robot system, and camera calibration method
US9383741B2 (en) Mobile robot, positioning system of mobile robot, and positioning method of mobile robot
US8306661B2 (en) Method and system for establishing no-entry zone for robot
JP5701055B2 (en) 7-axis articulated robot control method, control program, and robot controller
JP7111114B2 (en) Information processing device, information processing method, and information processing system
JP2017512549A5 (en)
JP2011011321A (en) Robot system and calibration method for the same
WO2012000400A1 (en) Method and device for controlling mechanical articulated arm
WO2019095506A1 (en) Mechanical arm and self-guiding operation method for mechanical arm
US20170266816A1 (en) Robot control apparatus, robot, and robot system
JP6897396B2 (en) Control devices, robot systems and control methods
WO2023013740A1 (en) Robot control device, robot control system, and robot control method
CN207858834U (en) Mechanical arm
Taylor et al. Flexible self-calibrated visual servoing for a humanoid robot
JPH09314487A (en) Method for controlling manipulator having redundant axis
JP2000039911A (en) Robot controller
KR102474838B1 (en) Apparatus, method and system for teaching robot
CN109648563A (en) Serial manipulator motion control method and computer storage medium
JP2019115950A (en) Robot control device, robot, and robot system
TWI597140B (en) Method to adjust teachings of a robot arm
US20210146542A1 (en) Control method for robot system
JPH0310781A (en) Articulated type robot
WO2023013698A1 (en) Robot control device, robot control system, and robot control method
JP7311971B2 (en) ROBOT CONTROL DEVICE AND ROBOT CONTROL METHOD

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 17932063

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 17932063

Country of ref document: EP

Kind code of ref document: A1