WO2022004177A1 - ロボットの関節構造 - Google Patents

ロボットの関節構造 Download PDF

Info

Publication number
WO2022004177A1
WO2022004177A1 PCT/JP2021/019118 JP2021019118W WO2022004177A1 WO 2022004177 A1 WO2022004177 A1 WO 2022004177A1 JP 2021019118 W JP2021019118 W JP 2021019118W WO 2022004177 A1 WO2022004177 A1 WO 2022004177A1
Authority
WO
WIPO (PCT)
Prior art keywords
joint structure
leg
rod
effective length
structure according
Prior art date
Application number
PCT/JP2021/019118
Other languages
English (en)
French (fr)
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 CN202180039289.6A priority Critical patent/CN115666877A/zh
Priority to US18/000,002 priority patent/US11833671B2/en
Priority to EP21833686.5A priority patent/EP4140665A4/en
Publication of WO2022004177A1 publication Critical patent/WO2022004177A1/ja

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J17/00Joints
    • B25J17/02Wrist joints
    • B25J17/0208Compliance devices
    • B25J17/0216Compliance devices comprising a stewart mechanism
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/0008Balancing devices
    • B25J19/0012Balancing devices using fluidic devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/0008Balancing devices
    • B25J19/0016Balancing devices using springs
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/003Programme-controlled manipulators having parallel kinematics
    • B25J9/0033Programme-controlled manipulators having parallel kinematics with kinematics chains having a prismatic joint at the base
    • B25J9/0039Programme-controlled manipulators having parallel kinematics with kinematics chains having a prismatic joint at the base with kinematics chains of the type prismatic-spherical-spherical
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/003Programme-controlled manipulators having parallel kinematics
    • B25J9/0033Programme-controlled manipulators having parallel kinematics with kinematics chains having a prismatic joint at the base
    • B25J9/0042Programme-controlled manipulators having parallel kinematics with kinematics chains having a prismatic joint at the base with kinematics chains of the type prismatic-universal-universal
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B25J9/104Programme-controlled manipulators characterised by positioning means for manipulator elements with cables, chains or ribbons
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/10Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B25J9/14Programme-controlled manipulators characterised by positioning means for manipulator elements fluid

Definitions

  • the present invention relates to a joint structure of a robot, and particularly to a joint structure suitable for a manipulator of a soft robot (soft robot).
  • the manipulator is generally configured with a highly rigid mechanism, and the three-dimensional position of the end effector is controlled while measuring the state with a sensor.
  • a robot composed of only a mechanism having high rigidity, for example, an operation involving contact with an object or an operation requiring higher accuracy than the measurement error of a sensor.
  • a so-called soft robot (soft robot) approach has been proposed.
  • a part of the robot is provided with a soft mechanism that is displaced or deformed by receiving an external force so as to automatically follow the shape of an object.
  • the compliance mechanism described in Patent Documents 1 and 2 is one example.
  • the present invention has been made in view of the above circumstances, and an object of the present invention is to provide a joint structure of a robot capable of active multi-degree-of-freedom control and also having softness.
  • the present disclosure is a joint structure connecting between the first element and the second element of a robot manipulator, and is a Stewart platform capable of controlling the relative position and / or angle of the second element with respect to the first element.
  • the Stewart platform has a first member to be joined to the first element, a second member to be joined to the second element, and a plurality of legs connecting the first member and the second member.
  • a drive mechanism that changes the effective length of each leg in order to change the relative position and / or angle of the second member with respect to the first member, and when an external force acts on the second member. It comprises a joint structure comprising a soft mechanism that elastically changes the effective length of the leg and restores the effective length of the leg when released from the external force.
  • the first element may be a joint of the manipulator and a link between the joints
  • the second element may be a link or an end effector on the end effector side of the first element.
  • the "effective length of the leg” can be considered as the distance from the connection point between the first member and the leg to the connection point between the second member and the leg. The same can be considered when the leg is composed of a structure in which a plurality of rods are connected or a bent member.
  • the leg is slidably supported by a support and has a rod that changes the effective length of the leg by sliding
  • the drive mechanism is a flexible wire attached to the rod. It may have a shaped member and an elastic member that elastically deforms when the linear member is pulled and the rod is slid, and generates an elastic restoring force that opposes the pulling force of the linear member.
  • the rod slides and the elastic member is gradually elastically deformed. Then, the slide of the rod stops when the tensile force and the elastic restoring force are balanced. According to such a structure, the sliding state of the rod can be easily and accurately controlled by adjusting the pulling force of the linear member.
  • the effective length of one leg may be determined only by the sliding state of the rods of that leg, or it may be determined by the total sliding state of the rods of all legs. In any case, the effective length of each leg can be accurately controlled by accurately controlling the sliding state of each rod.
  • the elastic member may also serve as the soft mechanism.
  • the elastic member when an external force acts in the same direction as the pulling force of the linear member, the elastic member is further deformed by the resultant force of the pulling force and the external force, and the effective length of the leg changes by changing the sliding state of the rod. Then, when the external force disappears, the sliding state of the rod returns to the position of equilibrium with the pulling force.
  • the elastic member includes a non-linear spring element, and the rigidity of the soft mechanism may be variable by changing the amount of deformation of the elastic member according to the amount of tension of the linear member. This also makes it possible to control the hardness (softness) of the joint structure.
  • the support may be a bearing provided on the first member. This configuration has the advantage that the structure of the legs themselves can be simplified.
  • the support may be a cylinder member provided on the leg and into which the rod is slidably inserted. This configuration has an advantage that the structure of the first member and the second member can be simplified.
  • the end portion of the linear member may be pulled out to the outside of the joint structure and connected to a drive source provided separately from the joint structure.
  • the leg has a rod that changes the effective length of the leg by moving in the length direction
  • the drive mechanism is an actuator that moves the rod in the length direction by a compressible fluid. You may. According to such a structure, the movement amount of the rod can be easily and accurately controlled by controlling the supply / discharge of the compressible fluid.
  • the compressible fluid of the actuator may also serve as the soft mechanism.
  • the compressible fluid inside the actuator is elastically compressed or elastically expanded, and the amount of movement of the rod changes.
  • the compressed or expanded compressible fluid returns to its original state, and the amount of movement of the rod returns to its original state.
  • the actuator may be an air cylinder.
  • a tube for supplying / discharging the compressible fluid to the actuator may be pulled out of the joint structure and connected to a drive source provided separately from the joint structure.
  • it may have a locking mechanism for switching between a free state in which the second element is independently movable from the first element and a locked state in which the second element is fixed to the first element. ..
  • the locked state the first element and the second element behave as if they were one rigid body.
  • This makes it possible to switch between a highly rigid robot (locked state) and a soft robot (free state).
  • the range of application of the robot can be expanded and efficient. It can be expected that the operation can be realized.
  • FIG. 1A and 1B are schematic views of a joint structure with a Stewart platform.
  • FIG. 2 is a diagram showing movement when an external force is applied.
  • FIG. 3 is a schematic diagram showing the overall configuration of the robot.
  • FIG. 4 is a perspective view of the joint structure.
  • 5A is a side view (home position) of the joint structure
  • FIG. 5B is a side view of the joint structure (z translation)
  • FIG. 5C is a side view of the joint structure (x translation)
  • FIG. 5D is a joint structure. It is a side view (rotation) of.
  • FIG. 6 is a diagram showing the characteristics of the nonlinear spring used in the modified example 1.
  • FIG. 7 is a diagram showing a modification 2.
  • FIG. 8 is a diagram showing a modified example 3.
  • FIG. 9 is a diagram showing a modified example 4.
  • FIGS. 1A and 1B are schematic views of the joint structure of a robot with a Stewart platform.
  • 1A is a sectional view taken along the line AA of FIG. 1B
  • FIG. 1B is a side view (viewed by arrow B in FIG. 1A).
  • This joint structure 1 is a device for connecting between the first element 11 and the second element 12 constituting the manipulator RM of the robot.
  • the manipulator RM is an articulated manipulator
  • the first element 11 is an element on the proximal end side of the manipulator RM
  • the second element 12 is an element on the distal end side of the first element 11.
  • the joint structure 1 has a Stewart platform 10 capable of controlling the relative position and / or angle of the second element 12 with respect to the first element 11.
  • the Stewart platform has a structure in which one member is supported by multiple legs, and by changing the effective length of each leg (by changing the combination of effective lengths of each leg), the x-direction, y-direction, and z It is a mechanism that gives a member six degrees of freedom of translation in the direction and rotation around the x-axis, y-axis, and z-axis.
  • Stewart platforms are also known as motion-based, 6-axis platforms, and 6-DOF platforms.
  • the Stewart platform 10 generally includes a first member 110 joined to the first element 11, a second member 120 joined to the second element 12, and a plurality of legs 130 connecting the first member 110 and the second member 120. And a drive mechanism 140 that changes the effective length of each leg 130.
  • the number of legs 130 is typically six, but configurations other than six may be adopted.
  • each leg 130 has a structure in which two rods 131 and 132 are flexibly connected to each other.
  • the rod 131 is supported by the bearing 111 of the first member 110, and the rod 132 is connected to the second member 120 via the universal joint 121.
  • a flexible linear member 150 is attached to the upper end of the rod 131.
  • the linear member 150 is drawn out of the joint structure 1 and connected to the drive source M.
  • the elastic member 160 is installed concentrically with the rod 131.
  • the drive mechanism 140 of the leg 130 is configured by the linear member 150 and the elastic member 160.
  • the drive mechanism 140 When a tensile force F1 is applied to the linear member 150 by the drive source M, the rod 131 slides upward in FIG. 1B, and the elastic member 160 is gradually elastically deformed (compressively deformed). Then, when the tensile force F1 and the elastic restoring force F2 of the elastic member 160 are balanced, the slide of the rod 131 is stopped, and the effective length of the leg 130 is stabilized. According to this structure, the effective length of the leg 130 can be easily and accurately controlled by adjusting the pulling force of the linear member 150 given from the drive source M.
  • the posture (position / angle) of the second member 120 is arbitrarily controlled by controlling the drive source M with a controller (not shown) and individually adjusting the effective length of each leg 130. be able to.
  • the left leg 130 is larger than the pulling force F1 for the right leg 130, the left leg 130 is shorter than the right leg 130, and the second member 120 rotates about the y-axis. is doing.
  • the elastic member 160 elastically changes the effective length of the leg 130 when an external force acts on the second member 120 (second element 12), and the effective length of the leg 130 when released from the external force. It also plays a role as a "soft mechanism" to restore. For example, as shown on the right side of FIG. 2, it is assumed that an external force acts on the second member 120 and the force F3 is applied in the direction of pushing up the leg 130 on the right side. In that case, the elastic member 160 is further compressed and deformed by the resultant force of the tensile force F1 and the external force F3, and the effective length of the right leg 130 is shortened. As a result, the relative positions and / or angles of the first element 11 and the second element 12 passively change following the external force. Then, when the external force F3 disappears, the effective length of the leg 130 returns to the position of equilibrium with the pulling force F1, as shown on the left side of FIG.
  • the drive source M may be a linear motor or a rotary motor.
  • the drive source M may be driven electrically or by fluid pressure.
  • the drive source M may drive the linear member 150 so as to determine the pull-in length of the linear member 150 instead of applying the tensile force F1 to the linear member 150.
  • the rod 131 is stationary at a position corresponding to the retracted length of the linear member 150, and is urged by the elastic member 160 by the elastic restoring force F2.
  • an external force that exceeds the elastic restoring force F2 at this time and compresses the elastic member 160 is applied to the rod 131, the rod 131 becomes larger as the elastic member 160 is compressed until the elastic restoring force F2 and the external force are balanced. Is moved, and the linear member 150, which is positioned in the length direction in the drive source M, is bent according to the movement of the rod 131. This deflection mainly occurs in the portion where the linear member 150 does not pass through the tube described below.
  • FIG. 3 is a schematic diagram showing the overall configuration of the robot.
  • the robot R may be any robot equipped with at least one manipulator, and may be of various types such as an industrial robot, a humanoid robot, a care robot, a transfer robot, a home-use robot, and a surgery support robot. Applicable to robots.
  • the industrial robot is one of the robots to which the joint structure 1 can be preferably applied.
  • industrial robots include horizontal articulated robots (SCARA robots), parallel link robots, and orthogonal robots.
  • SCARA robots horizontal articulated robots
  • parallel link robots parallel link robots
  • orthogonal robots the application position of the joint structure 1 is not limited to the connecting portion of the end effector E2, and may be applied to the connecting portion between the links.
  • the robot R of the present embodiment has a manipulator RM, a controller RC, and a drive source M as main configurations.
  • the manipulator RM is an articulated manipulator that has a plurality of links and joints that connect the links to each other and is driven by a servomotor.
  • the controller RC is a control device that controls the servomotor of the manipulator RM and the drive source M.
  • the end effector E2 is connected to the link E1 at the tip of the manipulator RM via the joint structure 1.
  • the link E1 corresponds to the first element 11 of FIG. 1B
  • the end effector E2 corresponds to the second element 12 of FIG. 1B.
  • the drive source M is a device for driving the drive mechanism 140 of the Stewart platform of the joint structure 1.
  • the drive source M may have any type and structure as long as it can pull the linear member 150 and send it out, but the pulling source M can change the effective length of the leg 130 against the elastic restoring force of the elastic member 160. A force and a stroke sufficient to secure the movable range of the Stewart platform and the end effector E2 are required.
  • a motor, a hydraulic actuator, a barometric pressure actuator, or the like may be used as the drive source M. It is preferable that an independent drive source M is provided for each leg 130.
  • FIGS. 4 and 5A to 5D The details of the joint structure 1 are shown in FIGS. 4 and 5A to 5D.
  • 4 is a perspective view of the joint structure 1
  • FIG. 5A is a side view (home position) of the joint structure 1
  • FIG. 5B is a side view of the joint structure 1 (z translation)
  • FIG. 5C is a joint structure 1.
  • FIG. 5D is a side view (rotation) of the joint structure 1.
  • the xyz coordinate system of the joint structure 1 is taken so that the normal line of the first member 110 (that is, the axial direction of the link E1) is the z-axis.
  • This joint structure 1 utilizes the Stewart platform 10 to move the end effector E2 with 6 degrees of freedom (translation in the x-direction, y-direction, and z-direction, and rotation around the x-axis, y-axis, and z-axis). Allows active control of.
  • the Stewart platform 10 has a structure in which a substantially disk-shaped first member 110 and a substantially disk-shaped second member 120 are connected by six legs 130.
  • the structure of the six legs 130 is common.
  • Each leg 130 is composed of two rods 131 and 132, and the rods 131 and 132 are flexibly connected by a pin joint 133.
  • the rod 131 on the proximal end side is supported by a slide bearing 111 installed in a through hole of the first member 110 so as to be able to slide in the z direction and rotate freely around the z axis.
  • the rod 132 on the distal end side is connected to the second member 120 via the universal joint 121, and is rotatable in any direction with respect to the second member 120.
  • a ball joint may be used to connect the rod 132 and the second member 120.
  • a flexible linear member 150 is attached to the end of the rod 131 on the base end side.
  • a metal wire is used as the linear member 150.
  • a cable (rope) made of chemical fiber or natural fiber may be used as the linear member 150.
  • the linear member 150 is drawn out of the joint structure 1 and connected to the drive source M. Of the path of the linear member 150 between the joint structure 1 and the drive source M, at least the curved portion of the linear member 150 passes through a non-stretchable tube (not shown) having fixed positions at both ends. When tension is applied to the linear member 150, the linear member 150 in the joint structure 1 is displaced according to the displacement of the linear member 150 in the drive source M.
  • an elastic member 160 is installed concentrically with the rod 131 between the flange 134 formed at the lower end of the rod 131 (the end on the pin joint 133 side) and the first member 110.
  • a coil spring compression spring
  • the controller RC controls the effective length to be taken by the six legs 130 and the control amount (pulling force, corresponding to the effective length). Calculate the amount of pull, etc.). Then, when the controller RC controls the drive source M and individually adjusts the effective lengths of the six legs 130, the second member 120 takes a target posture (position / angle).
  • the displacement of the second member 120 in the xy plane is 0 [mm] (that is, the xy coordinate of the center of the second member 120 is (0,0)), and the rotation of the second member 120 is 0 [deg].
  • the joint structure 1 of the present embodiment can also perform a passive movement following an external force.
  • a force in the z direction upward in the figure
  • the effective length of each leg 130 changes accordingly, as in the state of FIG. 5C.
  • the second member 120 may be displaced in the x direction.
  • the second member 120 in the state of FIG. 5B, when a moment acts on the second member 120, the second member 120 can rotate as in the state of FIG. 5D. Then, when released from the external force, the effective length of each leg 130 returns to the original state due to the restoring force of the elastic member 160, and the posture (position / angle) of the second member 120 also returns to the original state (""
  • the "original state” is an effective lengthless posture determined by active control by the drive mechanism 140). With such a soft mechanism, the end effector E2 can move independently of the link E1 and a so-called "soft robot" can be realized.
  • the relative position / angle of the link E1 (first element) and the end effector E2 (second element) is changed by changing the effective length of each leg 130 of the Stewart platform 10 by the drive mechanism 140.
  • Active multi-degree-of-freedom control can be realized.
  • the effective length of the leg 130 elastically changes, and the relative positions and / or angles of the link E1 and the end effector E2 passively follow the external force. Changes to. Therefore, it is possible to realize both active multi-degree-of-freedom control and softness.
  • the slide of the rod 131 is stopped when the tensile force of the linear member 150 and the elastic restoring force of the elastic member 160 are balanced, and the effective length of the leg 130 is stabilized. According to such a structure, the effective length of the leg 130 can be easily and accurately controlled by adjusting the pulling force of the linear member 150.
  • the joint structure 1 since the drive source M of the linear member 150 is separated from the joint structure 1 and arranged outside the joint structure 1, the joint structure 1 itself can be configured compactly and lightweight. can.
  • the joint structure 1 of the present embodiment has a locking mechanism, it is possible to switch between a highly rigid robot (locked state) and a soft robot (free state). For example, it can be expected that the application range of the robot can be expanded and efficient operation can be realized by appropriately using the robot according to the operation and the scene.
  • the drive mechanism 140, the soft mechanism, and the lock mechanism are configured by the same member. As a result, the number of parts can be reduced, the cost can be reduced, and the size of the device can be reduced.
  • FIG. 6 is a graph showing the difference in characteristics between a linear spring and a non-linear spring, in which the horizontal axis represents displacement (deflection) and the vertical axis represents load.
  • a linear spring has a direct proportional relationship between load and displacement, and its rigidity (spring constant) is constant regardless of the displacement, whereas a non-linear spring exhibits a characteristic that the rigidity (spring constant) increases as the displacement increases.
  • Such non-linear characteristics can be realized by, for example, making the coil diameter of the coil spring non-uniform, making the pitch of the coil spring non-uniform, making the wire diameter of the coil spring non-uniform, and the like.
  • the stretching amount of the linear member 150 in the free state is switched in multiple stages such as s1 [mm], s2 [mm], and s3 [mm] (s1 ⁇ s2 ⁇ s3), and is elastic.
  • the displacement of the member 160 may be changed.
  • the hardness (softness) of the joint structure 1 in the free state can be controlled.
  • FIG. 7 shows a modified example 2.
  • each leg 130 is formed of a rod 50, a cylinder member 51 into which the rod 50 is slidably inserted, a piston 52 provided at an end of the rod 50, a piston 52, and a cylinder member 51. It is composed of an elastic member 53 arranged in the space to be formed.
  • the leg 130 and the first member 110 and the leg 130 and the second member 120 are connected by a universal joint or a ball-and-socket joint, respectively.
  • the linear member 150 for driving the rod 50 is attached to the piston 52, passes through the inside of the cylinder member 51 and the through hole of the first member 110, and is pulled out to the outside of the joint structure 1.
  • the drive source M may drive the linear member 150 so as to determine the pull-in length of the linear member 150.
  • the elastic member 53 also plays a role as a soft mechanism. For example, when an external force acts in the same direction as the tensile force of the linear member 150, the elastic member 53 is further compressed and deformed by the resultant force of the tensile force and the external force, and the effective length of the leg 130 changes. Then, when the external force disappears, the effective length of the leg 130 returns to a position in equilibrium with the pulling force or a position corresponding to the determined pull-in length of the linear member 150.
  • the barometric actuator 61 is provided with two tubes 62 for supplying / discharging a compressible fluid (for example, air) to the barometric actuator 61. These tubes 62 may be drawn out of the joint structure 1 and connected to a drive source M provided separately from the joint structure 1. By separating the drive source M of the actuator from the joint structure 1 and arranging the drive source M outside the joint structure 1 in this way, the joint structure 1 itself can be configured compactly and lightweight.
  • a compressible fluid for example, air
  • the rod 60 when a fluid is introduced into the first chamber 611 of the barometric actuator 61 by the drive source M (for example, a compressor, a pump, etc.), the rod 60 is moved to the second chamber 612 side due to the differential pressure between the first chamber 611 and the second chamber 612. Move to.
  • the drive source M for example, a compressor, a pump, etc.
  • the compressible fluid in the barometric actuator 61 also plays a role as a soft mechanism.
  • the compressible fluid inside the barometric actuator 61 is elastically compressed or elastically expanded, and the effective length of the leg 130 changes.
  • the compressed or expanded compressible fluid returns to its original state, and the effective length of the leg 130 returns to its original state.
  • FIG. 9 shows a modified example 4.
  • Modification 4 is a modification of the lock mechanism.
  • the lock mechanism is roughly composed of a first lock piece 70 provided on the first member 110 and a second lock piece 71 provided on the second member 120.
  • the structure is such that the effective length of the leg 130 is shortened and the first lock piece 70 and the second lock piece 71 are engaged with each other to fix the leg 130 between the first member 110 and the second member 120.
  • a structure in which a convex portion is provided on one of the first lock piece 70 and the second lock piece 71 and a concave portion is provided on the other, and the convex portion and the concave portion are fitted may be used. With such a fitting method, the fixing force in the locked state can be increased. It is also possible to achieve relative positioning between the first member 110 and the second member 120 in the locked state.
  • a hemispherical convex portion and a conical concave portion are provided. According to this structure, the convex portion and the concave portion can be brought into contact with each other at an arbitrary angle, so that the second member 120 can be locked in an inclined posture with respect to the first member 110.
  • a joint structure (1) that connects between the first element (11) and the second element (12) of the robot. It has a Stewart platform (10) capable of controlling the relative position and / or angle of the second element (12) with respect to the first element (11).
  • the Stewart platform (10) is A first member (110) to be joined to the first element (11), A second member (120) to be joined to the second element (12), A plurality of legs (130) connecting the first member (110) and the second member (120), and A drive mechanism (140) that changes the effective length of each leg (130) in order to change the relative position and / or angle of the second member (120) with respect to the first member (110).

Abstract

ロボットの第1要素と第2要素の間を連結する関節構造が、前記第1要素に対する前記第2要素の相対的な位置及び/又は角度を制御可能なスチュワートプラットフォームを有する。前記スチュワートプラットフォームは、前記第1要素に接合する第1部材と、前記第2要素に接合する第2部材と、前記第1部材と前記第2部材とを接続する複数の脚と、前記第1部材に対する前記第2部材の相対的な位置及び/又は角度を変えるために、各脚の実効長さを変化させる駆動機構と、前記第2部材に対して外力が作用した場合に前記脚の実効長さを弾性的に変化させ、前記外力から解放された場合に前記脚の実効長さを復元させる、ソフト機構と、を有する。

Description

ロボットの関節構造
 本発明は、ロボットの関節構造に関し、特にソフトロボット(柔らかいロボット)のマニピュレータに好適な関節構造に関する。
 産業用ロボットは、マニピュレータを剛性の高い機構で構成し、センサによって状態計測を行いながらエンドエフェクタの3次元位置を制御する、というものが一般的である。しかしながら、剛性の高い機構のみで構成されるロボットは、例えば、対象物に対する接触を伴う動作や、センサの計測誤差よりも高い精度が要求される動作などが困難である。このような課題を解決する方法として、いわゆるソフトロボット(柔らかいロボット)というアプローチが提案されている。例えば、ロボットの一部に、外力を受けて変位ないし変形する柔らかい機構を設け、対象物の形状などに自動的に追従するようにする。特許文献1、2に記載されているコンプライアンス機構もその一例である。
特開平5-192892号公報 特開平8-118281号公報
 しかしながら、特許文献1、2で提案されているような従来のコンプライアンス機構は、可動範囲が非常に小さくかつ限定的な動きしかとれない(水平面内の微小な変位を可能とする程度)ため、適用できる場面や用途が限定的であった。
 本発明は上記実情に鑑みてなされたものであって、能動的な多自由度の制御が可能であり、かつ、柔らかさも兼ね備えた、ロボットの関節構造を提供することを目的とする。
 本開示は、ロボットのマニピュレータの第1要素と第2要素の間を連結する関節構造であって、前記第1要素に対する前記第2要素の相対的な位置及び/又は角度を制御可能なスチュワートプラットフォームを有し、前記スチュワートプラットフォームは、前記第1要素に接合する第1部材と、前記第2要素に接合する第2部材と、前記第1部材と前記第2部材とを接続する複数の脚と、前記第1部材に対する前記第2部材の相対的な位置及び/又は角度を変えるために、各脚の実効長さを変化させる駆動機構と、前記第2部材に対して外力が作用した場合に前記脚の実効長さを弾性的に変化させ、前記外力から解放された場合に前記脚の実効長さを復元させる、ソフト機構と、を有することを特徴とする関節構造を含む。
 ここで、第1要素はマニピュレータの関節と関節の間のリンクであってよく、第2要素は第1要素よりもエンドエフェクタ側のリンクまたはエンドエフェクタであってよい。この構造によれば、駆動機構によってスチュワートプラットフォームの各脚の実効長さを変化させることによって、第1要素と第2要素の相対的な位置及び/又は角度の能動的な多自由度制御が実現できる。加えて、ロボットに外力が作用した場合には、脚の実効長さが弾性的に変化し、外力に追従して第1要素と第2要素の相対的な位置及び/又は角度が受動的に変化する。したがって、能動的な多自由度制御と柔らかさの両立を実現することができる。
 「脚の実効長さ」は、第1部材と脚との接続点から第2部材と脚との接続点までの距離と考えればよい。脚が複数のロッドを連結した構造や、屈曲した部材から構成されている場合も、同様に考えればよい。
 前記脚は、支持体によってスライド自在に支持され、スライドすることによって前記脚の実効長さを変化させるロッドを有しており、前記駆動機構は、前記ロッドに取り付けられる、可撓性を有する線状部材と、前記線状部材を引っ張り前記ロッドをスライドさせると弾性変形し、前記線状部材の引っ張り力に抗する弾性復元力を発生する、弾性部材と、を有してもよい。この構造によれば、線状部材に引っ張り力をかけると、ロッドがスライドし弾性部材が徐々に弾性変形していく。そして、引っ張り力と弾性復元力が釣り合ったところでロッドのスライドが停止する。このような構造によれば、線状部材の引っ張り力を調整することによって、ロッドのスライド状態を簡単にかつ精度よく制御することができる。一つの脚の実効長さは、スチュワートプラットフォームの具体的構造によって、その脚のロッドのスライド状態だけで決まる場合と、すべての脚のロッドのスライド状態が総合されて決まる場合とがある。いずれの場合であれ、各ロッドのスライド状態を精度よく制御することにより、各脚の実効長さを精度よく制御することができる。
 この構造において、前記弾性部材が、前記ソフト機構を兼ねていてもよい。例えば、線状部材の引っ張り力と同じ方向に外力が作用すると、引っ張り力と外力の合力によって弾性部材がさらに変形し、ロッドのスライド状態が変化することによって脚の実効長さが変化する。そして、外力がなくなると、引っ張り力との釣り合いの位置までロッドのスライド状態が戻る。このように駆動機構とソフト機構を同一部材により構成することで、部品点数の削減、ひいてはコスト低減ならびに装置の小型化を図ることができる。
 前記弾性部材は、非線形ばね要素を含み、前記線状部材の引っ張り量によって前記弾性部材の変形量を変えることにより、前記ソフト機構の剛性が可変であってもよい。これにより、関節構造の堅さ(柔らかさ)の制御も可能となる。
 前記支持体は、前記第1部材に設けられた軸受であってもよい。この構成は、脚自体の構造をシンプルにできるという利点がある。
 前記支持体は、前記脚に設けられ、前記ロッドがスライド自在に挿入されたシリンダ部材であってもよい。この構成は、第1部材や第2部材の構造をシンプルにできるという利点がある。
 前記線状部材の端部が前記関節構造の外側に引き出され、前記関節構造とは別に設けられた駆動源に接続されていてもよい。このように線状部材の駆動源を関節構造とは別体にし、かつ、関節構造の外部に配置することにより、関節構造そのものをコンパクトかつ軽量に構成することが可能となる。
 前記脚は、長さ方向に移動することによって前記脚の実効長さを変化させるロッドを有しており、前記駆動機構は、圧縮性流体によって前記ロッドをその長さ方向に移動させるアクチュエータであってもよい。このような構造によれば、圧縮性流体の供給/排出を制御することによって、ロッドの移動量を簡単にかつ精度よく制御することができる。
 前記アクチュエータの前記圧縮性流体が、前記ソフト機構を兼ねていてもよい。例えば、ロッドを押し込む方向に外力が作用すると、アクチュエータ内部の圧縮性流体が弾性圧縮ないし弾性膨張し、ロッドの移動量が変化する。そして、外力がなくなると、圧縮ないし膨張した圧縮性流体が元に戻り、ロッドの移動量が元の状態に戻る。このように駆動機構とソフト機構を同一部材により構成することで、部品点数の削減、ひいてはコスト低減ならびに装置の小型化を図ることができる。
 前記アクチュエータは、エアシリンダであってもよい。
 前記アクチュエータに対し前記圧縮性流体の供給/排出を行うためのチューブが前記関節構造の外側に引き出され、前記関節構造とは別に設けられた駆動源に接続されていてもよい。このようにアクチュエータの駆動源を関節構造とは別体にし、かつ、関節構造の外部に配置することにより、関節構造そのものをコンパクトかつ軽量に構成することが可能となる。
 前記第2要素が前記第1要素から独立して運動自在となる自由状態と、前記第2要素が前記第1要素に固定されるロック状態との切り替えを行うロック機構をさらに有してもよい。ロック状態では第1要素と第2要素があたかも一つの剛体のように振る舞う。これにより、剛性の高いロボット(ロック状態)と柔らかいロボット(自由状態)を切り替えることができるので、例えば、ロボットの動作やシーンに合わせて適宜使い分けることにより、ロボットの応用範囲の拡大や効率的な動作を実現できると期待できる。
 本発明は、上記構成の少なくとも一部を有するロボットの関節構造として捉えてもよいし、ロボットのマニピュレータの要素の位置・角度を制御するアクチュエータとして捉えてもよい。また、そのような関節構造、もしくは、アクチュエータを有するロボットのマニピュレータないしロボットとして捉えてもよい。また、本発明は、上記構成の関節構造によってロボットのマニピュレータの要素の位置・角度を制御する制御方法ないし駆動方法などとして捉えることもできる。なお、上記構成の各々は可能な限り互いに組み合わせて本発明を構成することができる。
 本発明によれば、能動的な多自由度の制御が可能であり、かつ、柔らかさも兼ね備えた、ロボットの関節構造を提供できる。
図1A及び図1Bはスチュワートプラットフォームを有する関節構造の模式図である。 図2は外力が作用したときの動きを示す図である。 図3はロボットの全体構成を示す模式図である。 図4は関節構造の斜視図である。 図5Aは関節構造の側面図(ホームポジション)であり、図5Bは関節構造の側面図(z並進)であり、図5Cは関節構造の側面図(x並進)であり、図5Dは関節構造の側面図(回転)である。 図6は変形例1で用いられる非線形ばねの特性を示す図である。 図7は変形例2を示す図である。 図8は変形例3を示す図である。 図9は変形例4を示す図である。
 <適用例>
 図1A及び図1Bを参照して、本発明の適用例の一つについて説明する。図1A及び図1Bは、スチュワートプラットフォームを有するロボットの関節構造の模式図である。図1Aは図1BのA-A断面図であり、図1Bは側面図(図1AのB矢視)である。
 この関節構造1は、ロボットのマニピュレータRMを構成する第1要素11と第2要素12の間を連結する装置である。マニピュレータRMは多関節のマニピュレータであり、第1要素11はマニピュレータRMの基端側にある要素、第2要素12は第1要素11よりも先端側にある要素である。
 関節構造1は、第1要素11に対する第2要素12の相対的な位置及び/又は角度を制御可能なスチュワートプラットフォーム10を有する。スチュワートプラットフォームは、複数の脚で1つの部材を支える構造をもち、各脚の実効長さを変化させることで(各脚の実効長さの組合せを変えることで)、x方向,y方向,z方向の並進と、x軸周り,y軸周り,z軸周りの回転の6自由度の運動を部材に与える機構である。スチュワートプラットフォームは、モーションベース、6軸プラットフォーム、6自由度プラットフォームとも呼ばれる。
 スチュワートプラットフォーム10は、概略、第1要素11に接合する第1部材110と、第2要素12に接合する第2部材120と、第1部材110と第2部材120とを接続する複数の脚130と、各脚130の実効長さを変化させる駆動機構140と、を有する。脚130の数は典型的には6本であるが、6本以外の構成も採り得る。
 図1Bの例では、各脚130は2本のロッド131,132が屈曲自在に連結された構造を有する。ロッド131は、第1部材110の軸受111に支持され、ロッド132は、ユニバーサルジョイント121を介して第2部材120に接続されている。
 ロッド131の上端には、可撓性を有する線状部材150が取り付けられている。線状部材150は、関節構造1の外側に引き出され、駆動源Mに接続されている。また、ロッド131と同心に弾性部材160が設置されている。図1の構成例では、線状部材150と弾性部材160によって、脚130の駆動機構140が構成されている。
 駆動機構140の動作について説明する。駆動源Mによって線状部材150に引っ張り力F1をかけると、ロッド131が図1Bの上方向にスライドし、弾性部材160が徐々に弾性変形(圧縮変形)していく。そして、引っ張り力F1と弾性部材160の弾性復元力F2が釣り合ったところでロッド131のスライドが停止し、脚130の実効長さが安定する。この構造によれば、駆動源Mから与える線状部材150の引っ張り力を調整することによって、脚130の実効長さを簡単にかつ精度よく制御することができる。ロボットの稼働時は、コントローラ(不図示)によって駆動源Mを制御して各脚130の実効長さを個別に調整することにより、第2部材120の姿勢(位置・角度)を任意に制御することができる。図1Bの例では、左側の脚130に対する引っ張り力F1が右側の脚130に対する引っ張り力F1より大きいため、左側の脚130が右側の脚130より短くなり、第2部材120がy軸周りに回転している。
 弾性部材160は、第2部材120(第2要素12)に対して外力が作用した場合に脚130の実効長さを弾性的に変化させ、外力から解放された場合に脚130の実効長さを復元させる「ソフト機構」としての役割も担う。例えば、図2の右側に示すように、第2部材120に対して外力が作用することで、右側の脚130を押し上げる方向に力F3が加わったと仮定する。その場合、引っ張り力F1と外力F3の合力によって弾性部材160がさらに圧縮変形し、右側の脚130の実効長さが短くなる。これにより、外力に追従して第1要素11と第2要素12の相対的な位置及び/又は角度が受動的に変化する。そして、外力F3がなくなると、図2の左側に示すように、引っ張り力F1との釣り合いの位置まで脚130の実効長さが戻る。
 駆動源Mは、リニアモータまたは回転モータであってよい。駆動源Mは、電気的にまたは流体圧力によって駆動されるものであってよい。駆動源Mは、線状部材150に引っ張り力F1を与える代わりに、線状部材150の引き込み長さを決めるように線状部材150を駆動してもよい。この場合、ロッド131は線状部材150の引き込み長さに応じた位置で静止し、かつ、弾性部材160によって弾性復元力F2で付勢されている。このときの弾性復元力F2を超えて弾性部材160を圧縮する外力がロッド131に加わった場合には、弾性部材160が圧縮されるにしたがい大きくなる弾性復元力F2と外力とが釣り合うまでロッド131は移動し、駆動源Mにおいて長さ方向の位置決めがされている線状部材150にはロッド131の移動に応じたたわみが生じる。このたわみは、主として、線状部材150が後述のチューブの中を通っていない部分において生じる。
 以上述べた関節構造1によれば、能動的な多自由度制御と柔らかさの両立を実現することができる。
 <実施形態>
 図3を参照して、本発明の実施形態に係るロボット及びその関節構造について説明する。図3はロボットの全体構成を示す模式図である。
 本実施形態では、垂直多関節ロボットRのマニピュレータRMに対し、前述のスチュワートプラットフォームを備えた関節構造1を介してエンドエフェクタE2を取り付けた例を示す。ただしこれはあくまで一例であり、ロボットRの構成・種類は図3の例に限られない。具体的には、ロボットRは、少なくとも1つ以上のマニピュレータを備えるロボットであれば何でもよく、産業用ロボット、ヒューマノイドロボット、介護ロボット、搬送ロボット、家庭用ロボット、手術支援ロボットなど、さまざまな種類のロボットに適用可能である。その中でも産業用ロボットは、関節構造1を好ましく適用できるロボットの一つである。なお、産業用ロボットには、垂直多関節ロボットの他、水平多関節ロボット(スカラロボット)、パラレルリンクロボット、直交ロボットなどが含まれる。また、関節構造1の適用位置は、エンドエフェクタE2の連結部に限られず、リンク同士の連結部に適用してもよい。
 本実施形態のロボットRは、主な構成として、マニピュレータRM、コントローラRC、及び、駆動源Mを有する。マニピュレータRMは、複数のリンクとリンク同士を連結する関節(ジョイント)を有し、サーボモータによって駆動される多関節マニピュレータである。コントローラRCは、マニピュレータRMのサーボモータ及び駆動源Mを制御する制御装置である。
 マニピュレータRMの先端のリンクE1には、関節構造1を介してエンドエフェクタE2が連結されている。この例において、リンクE1が図1Bの第1要素11に相当し、エンドエフェクタE2が図1Bの第2要素12に相当する。駆動源Mは、関節構造1のスチュワートプラットフォームの駆動機構140を駆動するための装置である。駆動源Mは線状部材150を引っ張る動作と送り出す動作ができればどのような種類・構造でもよいが、弾性部材160の弾性復元力に抗して脚130の実効長さを変更し得る程度の引っ張り力と、スチュワートプラットフォーム及びエンドエフェクタE2の可動範囲を十分に担保できる程度のストロークとが必要である。例えば、モータ、油圧アクチュエータ、気圧アクチュエータなどを駆動源Mとして用いてもよい。なお、脚130ごとに独立した駆動源Mが設けられているとよい。
 図4及び図5A~図5Dに関節構造1の詳細を示す。図4は関節構造1の斜視図であり、図5Aは関節構造1の側面図(ホームポジション)であり、図5Bは関節構造1の側面図(z並進)であり、図5Cは関節構造1の側面図(x並進)であり、図5Dは関節構造1の側面図(回転)である。以降の説明では、第1部材110の法線(すなわちリンクE1の軸方向)がz軸となるように関節構造1のxyz座標系をとる。
 この関節構造1は、スチュワートプラットフォーム10を利用して、エンドエフェクタE2の6自由度の動き(x方向,y方向,z方向の並進と、x軸周り,y軸周り,z軸周りの回転)の能動的な制御を可能としている。
 スチュワートプラットフォーム10は、略円盤形状の第1部材110と略円盤形状の第2部材120とが、6本の脚130で接続された構造を有する。6本の脚130の構造は共通である。各脚130は、2本のロッド131,132から構成されており、ロッド131,132はピン継手133により屈曲自在に連結されている。基端側のロッド131は、第1部材110の貫通孔に設置されたすべり軸受111によって、z方向のスライドとz軸周りの回転が自在となるように支持されている。他方、先端側のロッド132は、ユニバーサルジョイント121を介して第2部材120に接続されており、第2部材120に対して任意の方向に回転自在である。なお、ロッド132と第2部材120の接続にはボールジョイントを用いてもよい。
 ロッド131の基端側の端部には、可撓性を有する線状部材150が取り付けられている。本実施形態では、金属製のワイヤを線状部材150として用いる。ただし線状部材150としては、化学繊維や天然繊維からなるケーブル(ロープ)を用いてもよい。線状部材150は、関節構造1の外側に引き出され、駆動源Mに接続されている。関節構造1と駆動源Mとの間の線状部材150の経路の内、少なくとも曲線となる部分の線状部材150は両端の位置が固定された非伸縮性の図示しないチューブの中を通っており、線状部材150に張力がかかっている状態では、駆動源Mにおける線状部材150の変位に応じて関節構造1における線状部材150が変位するようになっている。
 また、ロッド131の下端(ピン継手133側の端部)に形成されたフランジ134と第1部材110の間には、ロッド131と同心に弾性部材160が設置されている。本実施形態では、弾性部材160として、コイルばね(圧縮ばね)が用いられる。
 コントローラRCが、第2部材120の目標姿勢(第1部材110に対する相対的な位置及び角度)から、6本の脚130が取るべき実効長さとその実効長さに対応する制御量(引っ張り力、引っ張り量など)を計算する。そして、コントローラRCが、駆動源Mを制御して6本の脚130の実効長さを個別に調整すると、第2部材120が目標姿勢(位置・角度)をとる。
 ここで、6本の脚130の実効長さをLL1~LL6とし、最大実効長さをLLmax、最小実効長さをLLminと記す。図5Aは、LL1=LL2=LL3=LL4=LL5=LL6=LLmaxの状態、すなわち、6本の脚130すべてを最大実効長さLLmaxに設定した状態である。この場合、第2部材120のxy面内の変位は0[mm](つまり、第2部材120の中心のxy座標が(0,0))、第2部材120の回転は0[deg]となる。これが標準状態(ホームポジション)である。図5Bに示すように、LL1=LL2=LL3=LL4=LL5=LL6を維持したまま、6本の脚130の線状部材150を同じ量だけ引っ張っていくと、第2部材120がxy面との平行を保ったままz方向に並進する。また、LL1~LL6の実効長さを個別に調整すると、図5Cに示すように、第2部材120をx方向又はy方向に並進させたり、図5Dに示すように、第2部材120を回転させたりもできる。図5A~図5Dの状態を組合せることも可能であり、これにより能動的な6自由度制御が実現される。
 上記のような能動的な制御に加え、本実施形態の関節構造1は、外力に追従する受動的な動きを行うこともできる。例えば、図5Aの状態において、第2部材120にz方向(図の上向き)の力が作用したと仮定する。その場合、LL1=LL2=LL3=LL4=LL5=LL6が維持されたまま6本の脚130が持ち上がり、図5Bの状態のように第2部材120がz方向に変位し得る。あるいは、図5Bの状態において、第2部材120にx方向(図の左向き)の力が作用した場合には、それに追従して各脚130の実効長さが変化し、図5Cの状態のように第2部材120がx方向に変位し得る。あるいは、図5Bの状態において、第2部材120にモーメントが作用した場合には、図5Dの状態のように第2部材120が回転し得る。そして、外力から解放されると、弾性部材160の復元力によって、各脚130の実効長さが元の状態に戻り、第2部材120の姿勢(位置・角度)も元の状態に戻る(「元の状態」とは、駆動機構140による能動的な制御によって決められた実効長さないし姿勢のことである。)。このようなソフト機構によって、エンドエフェクタE2がリンクE1から独立して運動自在となり、いわゆる「柔らかいロボット」が実現できる。
 本実施形態の関節構造1において、弾性部材160の弾性復元力よりも十分に大きい力で全ての線状部材150を引っ張り上げると、弾性部材160が完全に潰れ、ロッド131の位置が固定される。このとき、LL1=LL2=LL3=LL4=LL5=LL6=LLmin、すなわち、6本の脚130すべてが最小実効長さLLminとなる。この状態においては、第2部材120に外力が作用しても容易には第2部材120が動かない。すなわち、上述したソフト機構が無効化され、リンクE1とエンドエフェクタE2があたかも一つの剛体のように振る舞うようになる。このようなロック機構によって、エンドエフェクタE2がリンクE1から独立して運動自在となる自由状態と、エンドエフェクタE2がリンクE1に固定されるロック状態との切り替えが実現できる。
 この構造によれば、駆動機構140によってスチュワートプラットフォーム10の各脚130の実効長さを変化させることによって、リンクE1(第1要素)とエンドエフェクタE2(第2要素)の相対的な位置・角度の能動的な多自由度制御が実現できる。加えて、ロボットRに外力が作用した場合には、脚130の実効長さが弾性的に変化し、外力に追従してリンクE1とエンドエフェクタE2の相対的な位置及び/又は角度が受動的に変化する。したがって、能動的な多自由度制御と柔らかさの両立を実現することができる。
 また、本実施形態の駆動機構140によれば、線状部材150の引っ張り力と弾性部材160の弾性復元力が釣り合ったところでロッド131のスライドが停止し、脚130の実効長さが安定する。このような構造によれば、線状部材150の引っ張り力を調整することによって、脚130の実効長さを簡単にかつ精度よく制御することができる。
 また、本実施形態では、線状部材150の駆動源Mを関節構造1とは別体にし、かつ、関節構造1の外部に配置したので、関節構造1そのものをコンパクトかつ軽量に構成することができる。
 また、本実施形態の関節構造1はロック機構を有するので、剛性の高いロボット(ロック状態)と柔らかいロボット(自由状態)を切り替えることができる。例えば、ロボットの動作やシーンに合わせて適宜使い分けることにより、ロボットの応用範囲の拡大や効率的な動作を実現できると期待できる。
 また、本実施形態の関節構造1では、駆動機構140とソフト機構とロック機構を同一部材により構成している。これにより、部品点数の削減、ひいてはコスト低減ならびに装置の小型化を図ることができる。
 <変形例>
 上記実施形態は、本発明の構成例を例示的に説明するものに過ぎない。本発明は上記の具体的な形態には限定されることはなく、その技術的思想の範囲内で種々の変形が可能である。
 変形例1では、弾性部材160として、非線形ばね要素を用いる。図6は、線形ばねと非線形ばねの特性の違いを示すグラフであり、横軸が変位(たわみ)、縦軸が荷重を示している。線形ばねは、荷重と変位が正比例の関係となり、変位によらず剛性(ばね定数)が一定であるのに対し、非線形ばねは、変位が大きくなるほど剛性(ばね定数)が増すという特性を示す。このような非線形特性は、例えば、コイルばねのコイル径を不均一にする、コイルばねのピッチを不等間隔にする、コイルばねの線径を不均一にする、などの方法により実現できる。
 例えば、駆動源Mの制御により、自由状態における線状部材150の延伸量をs1[mm]、s2[mm]、s3[mm](s1<s2<s3)のように多段階に切り替え、弾性部材160の変位を変えられるようにしてもよい。これにより、自由状態における関節構造1の堅さ(柔らかさ)を制御することができる。例えば、ロボットの動作やシーンに合わせて、適した堅さ(柔らかさ)になるように調整することにより、ロボットの応用範囲の拡大や効率的な動作を実現できると期待できる。
 図7に変形例2を示す。変形例2は、脚、駆動機構、及び、ソフト機構の構成が上記実施形態と異なる。図7に示すように、各脚130は、ロッド50と、ロッド50がスライド自在に挿入されたシリンダ部材51と、ロッド50の端部に設けられるピストン52と、ピストン52とシリンダ部材51で形成される空間に配置される弾性部材53とから構成される。脚130と第1部材110の間、及び、脚130と第2部材120の間は、それぞれユニバーサルジョイント又は球関節で接続される。ロッド50を駆動するための線状部材150は、ピストン52に取り付けられ、シリンダ部材51の内部及び第1部材110の貫通孔を通り、関節構造1の外側に引き出されている。
 この構成において、駆動源Mによって線状部材150に引っ張り力をかけると、ロッド50がシリンダ部材51の中へと引き込まれ、弾性部材53が徐々に弾性変形(圧縮変形)していく。そして、引っ張り力と弾性部材53の弾性復元力が釣り合ったところでロッド50のスライドが停止し、脚130の実効長さが安定する。この構造によっても、駆動源Mから与える線状部材150の引っ張り力を調整することによって、脚130の実効長さを簡単にかつ精度よく制御することができる。この構成においても、駆動源Mは、線状部材150の引き込み長さを決めるように線状部材150を駆動してもよい。
 また、弾性部材53は、ソフト機構としての役割も担う。例えば、線状部材150の引っ張り力と同じ方向に外力が作用すると、引っ張り力と外力の合力によって弾性部材53がさらに圧縮変形し、脚130の実効長さが変化する。そして、外力がなくなると、引っ張り力との釣り合いの位置または線状部材150の決定された引き込み長さに対応する位置まで脚130の実効長さが戻る。
 図8に変形例3を示す。変形例3は、脚、駆動機構、及び、ソフト機構の構成が上記実施形態と異なる。図8に示すように、各脚130は、ロッド60と、ロッド60を脚130の実効長さ方向に移動させる気圧アクチュエータ(エアシリンダともいう)61とから構成される。脚130と第1部材110の間、及び、脚130と第2部材120の間は、それぞれユニバーサルジョイントで接続される。
 気圧アクチュエータ61に対し圧縮性流体(例えば空気)の供給/排出を行うための2本のチューブ62が気圧アクチュエータ61に設けられている。これらのチューブ62は、関節構造1の外側に引き出され、関節構造1とは別に設けられた駆動源Mに接続されていてもよい。このようにアクチュエータの駆動源Mを関節構造1とは別体にし、かつ、関節構造1の外部に配置することにより、関節構造1そのものをコンパクトかつ軽量に構成することが可能となる。
 この構成において、駆動源M(例えばコンプレッサ、ポンプなど)によって気圧アクチュエータ61の第1室611に流体を導入すると、第1室611と第2室612の差圧によりロッド60が第2室612側に移動する。逆に、第2室612に流体を導入すると、ロッド60を第1室611側に移動させることができる。これにより、脚130の実効長さを簡単にかつ精度よく制御することができる。
 この構成においては、気圧アクチュエータ61内の圧縮性流体がソフト機構としての役割も担う。例えば、ロッド60を押し込む方向に外力が作用すると、気圧アクチュエータ61内部の圧縮性流体が弾性圧縮ないし弾性膨張し、脚130の実効長さが変化する。そして、外力がなくなると、圧縮ないし膨張した圧縮性流体が元に戻り、脚130の実効長さが元の状態に戻る。
 図9に変形例4を示す。変形例4は、ロック機構の変形例である。ロック機構は、概略、第1部材110に設けられた第1ロック片70と、第2部材120に設けられた第2ロック片71とから構成される。脚130の実効長さを短くし、第1ロック片70と第2ロック片71とを係合させることによって、第1部材110と第2部材120の間の固定を図る構造である。
 ここで、第1ロック片70と第2ロック片71のうちの一方に凸部を設け、他方に凹部を設け、凸部と凹部が嵌合する構造としてもよい。このような嵌合方式によりロック状態における固定力を高めることができる。また、ロック状態における第1部材110と第2部材120の間の相対的な位置決めを図ることもできる。図9の例では、半球形状の凸部と円錐形状の凹部を設けている。この構造によれば、凸部と凹部とを任意の角度で接触させることができるので、第1部材110に対して第2部材120を傾けた姿勢でロックすることが可能となる。
 <付記1>
 (1)ロボットの第1要素(11)と第2要素(12)の間を連結する関節構造(1)であって、
 前記第1要素(11)に対する前記第2要素(12)の相対的な位置及び/又は角度を制御可能なスチュワートプラットフォーム(10)を有し、
 前記スチュワートプラットフォーム(10)は、
  前記第1要素(11)に接合する第1部材(110)と、
  前記第2要素(12)に接合する第2部材(120)と、
  前記第1部材(110)と前記第2部材(120)とを接続する複数の脚(130)と、
  前記第1部材(110)に対する前記第2部材(120)の相対的な位置及び/又は角度を変えるために、各脚(130)の実効長さを変化させる駆動機構(140)と、
  前記第2部材(120)に対して外力が作用した場合に前記脚(130)の実効長さを弾性的に変化させ、前記外力から解放された場合に前記脚(130)の実効長さを復元させる、ソフト機構(160)と、を有する
ことを特徴とする関節構造。
1:関節構造、10:スチュワートプラットフォーム
11:第1要素、12:第2要素
50:ロッド、51:シリンダ部材、52:ピストン、53:弾性部材
60:ロッド、61:気圧アクチュエータ、62:チューブ
70:第1ロック片、71:第2ロック片
110:第1部材、111:軸受
120:第2部材、121:ユニバーサルジョイント
130:脚、131:ロッド、132:ロッド、133:ピン継手、134:フランジ
140:駆動機構、150:線状部材、160:弾性部材
E1:リンク、E2:エンドエフェクタ
R:ロボット、RM:マニピュレータ、RC:コントローラ、M:駆動源

Claims (12)

  1.  ロボットのマニピュレータの第1要素と第2要素の間を連結する関節構造であって、
     前記第1要素に対する前記第2要素の相対的な位置及び/又は角度を制御可能なスチュワートプラットフォームを有し、
     前記スチュワートプラットフォームは、
      前記第1要素に接合する第1部材と、
      前記第2要素に接合する第2部材と、
      前記第1部材と前記第2部材とを接続する複数の脚と、
      前記第1部材に対する前記第2部材の相対的な位置及び/又は角度を変えるために、各脚の実効長さを変化させる駆動機構と、
      前記第2部材に対して外力が作用した場合に前記脚の実効長さを弾性的に変化させ、前記外力から解放された場合に前記脚の実効長さを復元させる、ソフト機構と、を有することを特徴とする関節構造。
  2.  前記脚は、支持体によってスライド自在に支持され、スライドすることによって前記脚の実効長さを変化させるロッドを有しており、
     前記駆動機構は、
      前記ロッドに取り付けられる、可撓性を有する線状部材と、
      前記線状部材を引っ張り前記ロッドをスライドさせると弾性変形し、前記線状部材の引っ張り力に抗する弾性復元力を発生する、弾性部材と、を有する
    ことを特徴とする請求項1に記載の関節構造。
  3.  前記弾性部材が、前記ソフト機構を兼ねている
    ことを特徴とする請求項2に記載の関節構造。
  4.  前記弾性部材は、非線形ばね要素を含み、
     前記線状部材の引っ張り量によって前記弾性部材の変形量を変えることにより、前記ソフト機構の剛性が可変である
    ことを特徴とする請求項3に記載の関節構造。
  5.  前記支持体は、前記第1部材に設けられた軸受である
    ことを特徴とする請求項2に記載の関節構造。
  6.  前記支持体は、前記脚に設けられ、前記ロッドがスライド自在に挿入されたシリンダ部材である
    ことを特徴とする請求項2に記載の関節構造。
  7.  前記線状部材の端部が前記関節構造の外側に引き出され、前記関節構造とは別に設けられた駆動源に接続されている
    ことを特徴とする請求項2に記載の関節構造。
  8.  前記脚は、長さ方向に移動することによって前記脚の実効長さを変化させるロッドを有しており、
     前記駆動機構は、圧縮性流体によって前記ロッドをその長さ方向に移動させるアクチュエータである
    ことを特徴とする請求項1に記載の関節構造。
  9.  前記アクチュエータの前記圧縮性流体が、前記ソフト機構を兼ねている
    ことを特徴とする請求項8に記載の関節構造。
  10.  前記アクチュエータは、エアシリンダである
    ことを特徴とする請求項8に記載の関節構造。
  11.  前記アクチュエータに対し前記圧縮性流体の供給/排出を行うためのチューブが前記関節構造の外側に引き出され、前記関節構造とは別に設けられた駆動源に接続されている
    ことを特徴とする請求項8に記載の関節構造。
  12.  前記第2要素が前記第1要素から独立して運動自在となる自由状態と、前記第2要素が前記第1要素に固定されるロック状態との切り替えを行うロック機構をさらに有する
    ことを特徴とする請求項1~11のうちいずれか1項に記載の関節構造。
PCT/JP2021/019118 2020-06-29 2021-05-20 ロボットの関節構造 WO2022004177A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN202180039289.6A CN115666877A (zh) 2020-06-29 2021-05-20 机器人的关节结构
US18/000,002 US11833671B2 (en) 2020-06-29 2021-05-20 Joint structure for robot
EP21833686.5A EP4140665A4 (en) 2020-06-29 2021-05-20 JOINT STRUCTURE FOR ROBOTS

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2020111710A JP2022010920A (ja) 2020-06-29 2020-06-29 ロボットの関節構造
JP2020-111710 2020-06-29

Publications (1)

Publication Number Publication Date
WO2022004177A1 true WO2022004177A1 (ja) 2022-01-06

Family

ID=79315918

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/019118 WO2022004177A1 (ja) 2020-06-29 2021-05-20 ロボットの関節構造

Country Status (6)

Country Link
US (1) US11833671B2 (ja)
EP (1) EP4140665A4 (ja)
JP (1) JP2022010920A (ja)
CN (1) CN115666877A (ja)
TW (1) TWI763505B (ja)
WO (1) WO2022004177A1 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116766141B (zh) * 2023-08-18 2023-10-20 中国科学院长春光学精密机械与物理研究所 粗精两级驱动六自由度并联调整平台

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05192892A (ja) 1992-01-21 1993-08-03 Citizen Watch Co Ltd コンプライアンス機能を有するロボットハンド
JPH08118281A (ja) 1994-10-25 1996-05-14 Nitta Ind Corp ロボット用リストコンプライアンス装置
JPH08281581A (ja) * 1995-04-11 1996-10-29 Nippon Steel Corp パラレルリンクマニピュレータのリンクパラメータ同定方法
JP2009006415A (ja) * 2007-06-26 2009-01-15 Ihi Corp 搬送ロボットとその動作制御方法並びに協調搬送システム及び方法
JP2009107030A (ja) * 2007-10-26 2009-05-21 Univ Waseda 制御装置、制御方法、及び2足歩行ロボット

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3295224A (en) * 1964-12-07 1967-01-03 Franklin Institute Motion simulator
DE3620391A1 (de) * 1986-06-18 1987-12-23 Wzl Lab Fuer Werkzeugmaschinen Vorrichtung zur loesbaren verbindung eines werkzeuges, greifers, messgeraetes oder anderen wirksystems mit dem arm eines roboters oder dergleichen
US5451134A (en) * 1991-10-22 1995-09-19 Bryfogle; Mark D. Material handling devices and controllers
US6431019B1 (en) * 2001-03-21 2002-08-13 The United States Of America As Represented By The Secretary Of The Navy Low cost, high-strength robotic arm
US20060235571A1 (en) * 2003-09-12 2006-10-19 Katsuyuki Baba Access control system in radio lan system
US9300872B2 (en) * 2013-03-15 2016-03-29 Tolo, Inc. Hybrid stabilizer with optimized resonant and control loop frequencies
FR3042590B1 (fr) * 2015-10-15 2017-11-10 Micro-Controle - Spectra-Physics Procede et systeme de compensation d’erreurs de precision d’un hexapode.
JP6551740B2 (ja) * 2015-10-28 2019-07-31 Smc株式会社 流体制御弁
CN109093597A (zh) * 2018-08-23 2018-12-28 合肥合茂电子科技有限公司 一种机器人手腕结构
NL2023019B1 (en) * 2019-04-29 2020-11-05 Rocsys B V Charging infrastructure with a charging station for a vehicle

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05192892A (ja) 1992-01-21 1993-08-03 Citizen Watch Co Ltd コンプライアンス機能を有するロボットハンド
JPH08118281A (ja) 1994-10-25 1996-05-14 Nitta Ind Corp ロボット用リストコンプライアンス装置
JPH08281581A (ja) * 1995-04-11 1996-10-29 Nippon Steel Corp パラレルリンクマニピュレータのリンクパラメータ同定方法
JP2009006415A (ja) * 2007-06-26 2009-01-15 Ihi Corp 搬送ロボットとその動作制御方法並びに協調搬送システム及び方法
JP2009107030A (ja) * 2007-10-26 2009-05-21 Univ Waseda 制御装置、制御方法、及び2足歩行ロボット

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP4140665A4

Also Published As

Publication number Publication date
US20230202056A1 (en) 2023-06-29
EP4140665A4 (en) 2024-04-24
CN115666877A (zh) 2023-01-31
TWI763505B (zh) 2022-05-01
JP2022010920A (ja) 2022-01-17
US11833671B2 (en) 2023-12-05
EP4140665A1 (en) 2023-03-01
TW202200331A (zh) 2022-01-01

Similar Documents

Publication Publication Date Title
US7367771B2 (en) Light weight parallel manipulators using active/passive cables
US7673537B2 (en) Parallel manipulator
US9895798B2 (en) Device for movement between an input member and an output member
US6840127B2 (en) Tendon link mechanism with six degrees of freedom
US4720923A (en) Remote center compliance system
KR101072818B1 (ko) 분산구동 메커니즘을 갖는 매니퓰레이터
GB2454721A (en) Controlling the translation and orientation of a moveable platform with six-degrees-of--freedom
US20160243697A1 (en) Multi-articulated manipulator
WO2022004177A1 (ja) ロボットの関節構造
KR20160109376A (ko) 공간 순응 손가락 모듈 및 이를 구비한 그리퍼
JPH06328374A (ja) マイクロマニピュレータ
US10400944B2 (en) Counterbalance system and/or a method for counterbalancing a load
JPH0811080A (ja) 空間3自由度の駆動装置
Li et al. Design and analysis of a new 3-DOF compliant parallel positioning platform for nanomanipulation
Tanaka et al. Development of two types of 2-DOF wrist joint driven by pneumatic artificial muscles
JP2020110888A (ja) ロック機構付きロボットハンド
WO2019046898A1 (en) TRANSLATIONAL PARALLEL MANIPULATOR
US11465278B2 (en) Robotic manipulator including pneumatic artificial muscle
WO2021241181A1 (ja) ロボットの関節構造
JP3932283B2 (ja) ロボットのコンプライアンス装置
JP2021186961A (ja) ロボットの関節構造
Grames et al. A meso-scale rolling-contact gripping mechanism for robotic surgery
Glazunov et al. Development of parallel-structured mechanisms with kinematic and dynamic uncoupling
CN115476331B (zh) 机械手以及主从随动设备
JP4717878B2 (ja) マイクロマニピュレータ

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: 21833686

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2021833686

Country of ref document: EP

Effective date: 20221125

NENP Non-entry into the national phase

Ref country code: DE