JP4030348B2 - Wire drive robot - Google Patents

Description

[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a robot in which a body side member and a terminal side member are connected by a joint, for example, a robot in which a foot is connected to a lower leg (shin) via an ankle joint, and a wire is pulled. Thus, the present invention relates to a robot in which a distal side member rotates around a joint.
[0002]
[Prior art]
Recently, development of robots simulating the shapes and movements of people and animals, such as humanoid robots that perform upright walking and animal robots that perform quadrupedal walking, has become active. In the case of such a robot, a technique is required in which the end side member is connected to the body side member via a multi-axis joint and the joint angle is independently adjusted for each axis.
The “torso-side member and end-side member” here are, for example, “torso and head”, “torso and upper arm”, “upper arm and forearm”, “forearm and palm”, “Palm and fingers”, “torso and thigh”, “thigh and lower leg”, “lower leg and foot”, and the like. The “foot part” refers to a member on the distal side from the ankle joint.
[0003]
When adjusting the joint angle of the multi-axis joint connecting the body side member and the end side member, generally, a motor is attached to each rotation shaft of the joint, and each rotation shaft of the joint is rotated by the rotation of the motor. Since the rotation shaft is directly rotated by a motor, the apparatus configuration can be simplified and the rotation angle can be easily adjusted. However, in this method, it is necessary to provide a motor at a position far away from the body side member, and the moment of inertia of the end side member increases. For example, in order to rotate the thigh around the hip joint, it is necessary to rotate the lower limb where the moment of inertia is increased by the motor present in the ankle. For this reason, a large motor is required to rotate the lower limbs around the hip joint, and a large amount of energy is required.
[0004]
Therefore, a structure has been developed in which an actuator for adjusting the joint angle is provided at the body side member or a position close thereto, and the actuator and the joint are connected by a wire. In this technique, a pulley is fixed to each rotation shaft of the joint, and this pulley is rotated by a wire.
According to this, for example, the moment of inertia of the lower limbs around the hip joint can be reduced, and the actuator for adjusting the rotation angle of the hip joint can be reduced. However, in this method, it is necessary to fix a pulley to each rotation shaft of the joint, which increases the joint size.
[0005]
In the case of a puppet, attach the wire directly to the distal member. According to this method, it is not necessary to fix a pulley for each rotation axis of the joint, and the joint size does not increase. However, in the system in which the wire is directly attached to the distal side member, as the distal side member rotates around the joint, the wire is locally bent at the connection point between the distal side member and the wire, and this is repeated. There is a problem that the wire is fatigued and easily cut.
[0006]
[Problems to be solved by the invention]
In the system in which the actuator for rotating the distal side member around the joint is provided for each joint, the problem that the moment of inertia becomes large is solved by using a wire in the present invention. The problem that the joint size increases in the method of rotating the joint shaft by rotating the pulley using the extension of the wire is solved by directly connecting the wire to the distal side member.
[0007]
However, in the method in which the wire is directly connected to the end side member and the pulley is not used, the wire is locally bent and cut at the connection point between the end side member and the wire even if the above-mentioned problem can be solved. The problem of being easy remains. For example, when a wire connected to the upper surface of the foot portion in front of the ankle joint is pulled toward the thigh side, the toe lifts, and the angle formed by the wire and the foot portion becomes larger than that in the standard state. Conversely, when the wire is loosened, the tip of the toe is lowered, and the angle formed by the wire and the foot becomes smaller than that in the standard state. Due to the change in the posture of the end member, the wire is likely to be broken into a locally bent stop at the connection point.
The first problem of the present invention is that the wire is directly connected to the end side member and the pulley is not used, but the phenomenon that the wire is locally bent at the connection point due to the posture change of the end side member is generated. It is to prevent the wire from being cut easily.
[0008]
Further, in the system in which the wire is directly connected to the end side member, the horizontal distance between the wire connection point and the joint rotation axis, that is, the arm length of the moment changes with the change in the attitude of the end side member. As a result, the magnitude of the moment for rotating the end member changes greatly.
The second problem of the present invention is to suppress the change in the magnitude of the moment that rotates the distal side member by suppressing the change in the arm length of the moment while being a method of directly connecting the wire to the distal side member. It is in.
[0009]
In order to increase the durability of the wire connection portion, it is effective to attach a wire termination guide near the wire connection point. When the joint is a multi-axis joint, there is a problem that the wire deviates more than the guide width of the wire end guide and deviates from the wire end guide due to various posture changes of the end side member. If a wire end guide having a groove such as a V-shaped groove pulley is used, it is possible to prevent the wire from deviating from the wire end guide. It is not possible to prevent the wire from bending locally at a location away from the groove.
The third object of the present invention is to realize a guide guide mechanism that can always guide the vicinity of the connection point of the wire with the terminal member against the change in the posture of the terminal member.
[0010]
[Means, actions and effects for solving problems]
  In the robot of the present invention, the body side member and the terminal side member are connected by joints, and the terminal ends of the plurality of wires are connected to the terminal side member at a plurality of locations, and the expansion and contraction of the plurality of wires are performed. The distal member is moved by the combination of A wire end guide having an arcuate surface for guiding the vicinity of the wire end is fixed near the wire end connection point of the end member of the robot according to the present invention.
  A robot embodied by the present invention includes a body side member, a terminal side member, a body side member, and a terminal side member connected in a rotatable manner around the X axis and the Y axis perpendicular to the X axis. It has a shaft joint. This robotThe endA first wire termination guide fixed to the end member;A first wire whose end is connected to a first wire end guide;A first actuator for advancing and retracting the other end of the first wire is provided. The first wire end guide has an arc surface whose central axis extends in the Y-axis direction and has a predetermined width in the Y-axis direction,It is located on one side of the multi-axis joint with respect to the X-axis direction. First wire termination guideArc face ofIs1st wireA part from the end of a certain length (near the end)I am guiding you. Also, this robotThe endA second wire termination guide fixed to the end member;A second wire whose end is connected to a second wire end guide;A second actuator for advancing and retracting the other end of the second wire is provided. The second wire end guide has an arc surface whose central axis extends in the Y-axis direction and has a predetermined width in the Y-axis direction,It is located on the other side of the multi-axis joint with respect to the X-axis direction and is located on one side of the multi-axis joint with respect to the Y-axis direction. Second wire termination guideArc face ofIsSecond wireA part from the end of a certain length (near the end)We are guiding. In addition, this robotThe endA third wire termination guide fixed to the end member;A third wire whose end is connected to a third wire end guide;A third actuator for advancing and retracting the other end of the third wire is provided. The third wire end guide has an arc surface whose central axis extends in the Y-axis direction and has a predetermined width in the Y-axis direction,It is located on the other side of the multi-axis joint with respect to the X-axis direction and is located on the other side of the multi-axis joint with respect to the Y-axis direction. Third wire termination guideArc face ofIs3rd wireA part from the end of a certain length (near the end)Is guiding.
  According to this, since the wire is guided along the circular arc surface, it is possible to prevent the wire from being locally bent at the wire connecting portion with respect to the change in the posture of the end side member. This improves the durability of the wire connection.
[0011]
  The robot of the present inventionToIfThe arc surface of the first wire end guide faces the one side with respect to the X-axis direction, and the arc surface of the second wire end guide and the arc surface of the third wire end guide face the other side with respect to the X-axis direction. It is preferable.
[0012]
  In the robot of the present invention, it is preferable that the center of the arc of the wire end guide is closer to the body side member than the connection point of the wire end. That is, the central axis of the arc surface of the first wire end guide is the first wire.The end of is connectedCloser to the body side member than the connection point, the central axis of the arc surface of the second wire end guide is the second wireThe end of is connectedCloser to the fuselage side member than the connection point, the central axis of the arc surface of the third wire end guide is the third wireThe end of is connectedIt is preferable to be closer to the body side member than the connection point.
  According to this, even if the contact point between the wire and the wire end guide moves with the change in the posture of the end side member, the wire is always in contact with the arc surface of the guide. As a result, a change in the arm length of the moment can be absorbed, and a change in the magnitude of the moment can be suppressed. Furthermore, the size of the range through which the wire passes can be kept small, and the wire can be prevented from interfering with other members or the wire from greatly changing the passing position.
[0013]
DETAILED DESCRIPTION OF THE INVENTION
An embodiment embodying the present invention will be described with reference to FIGS. In this specification, the front-rear direction of the foot (the direction of movement of the robot) is the X-axis, the left-right direction is the Y-axis, and the direction in which the lower leg or torso extends is the Z-axis. Each axis is orthogonal to each other.
In this embodiment, the present invention is applied to a lower limb of a robot. The left and right lower limbs are mirror-symmetric. 1 is a front view of both lower limbs of the robot of this embodiment, FIG. 2 is a side view of the left lower limb, FIG. 3 is a view for explaining the structure of an ankle joint, and FIG. 4 is a detail of a ball screw. FIG. 5 to FIG. 14 are diagrams for explaining the movement of the foot.
[0014]
As shown in FIG. 1, the left and right lower limbs 12 of the robot 10 of the present embodiment are composed of a thigh 14, a crus (shin) 16, and a foot 18, and the thigh 14 and the torso 20 are hip joints 22. The thigh 14 and the lower leg 16 are connected by a knee joint 24, and the lower leg 16 and the foot 18 are connected by an ankle joint 26.
[0015]
First, the hip joint 22 will be described. As shown in FIG. 2, a disk 36 that rotates about the Z axis is attached to a plate-like pelvic portion 28 that extends substantially horizontally by a bearing 34. A pair of discs 36 are provided on the left and right in FIG. A shaft 30 extending from the pelvic part 28 side to the thigh part 14 side (extending in the Z-axis direction) is fixed to the center of each disk 36. The shaft 30 rotates around the Z axis with respect to the pelvic part 28.
The upper end of the thigh 14 is connected to the lower end of the shaft 30 by a universal joint 32. The universal joint 32 allows the thigh 14 to rotate about the X axis and the Y axis with respect to the shaft 30. The hip joint 22 has a shaft 30 that can rotate about the Z axis with respect to the pelvic part 28, and a universal joint 32 that allows the thigh 14 to rotate about the X axis and the Y axis with respect to the shaft 30. A three-axis joint that allows rotation about each of the X, Y, and Z axes.
[0016]
Next, the knee joint 24 will be described. Two flanges 40 arranged in parallel in the Y-axis direction extend downward at the lower end of each thigh 14, and two lines arranged in parallel in the Y-axis direction at the upper end of the shaft 42 constituting each crus 16. A flange 44 is provided facing upward. The knee joint 24 includes a shaft 46 that extends through the flanges 40 and 44 in the Y-axis direction. The knee joint 24 allows the lower leg 16 to rotate about the Y axis with respect to the thigh 14.
[0017]
  Next, the ankle joint 26 will be described. FIG. 3 is a simplified and deformed view for explaining the structure of the ankle joint 26 and does not necessarily match the actual shape and dimensions. Two flanges 58 arranged in parallel to the X-axis direction extend downward from the lower portion of the shaft 42 of the lower leg 16. Further, two flanges 60 arranged in parallel with the Y-axis direction extend upward on the upper surface of the foot 18. The flange 58 of the lower leg 16 and the flange 60 of the foot 18 are connected by a cross-shaped universal joint 62 to form a universal joint. The ankle joint 26 is the lower leg16In contrast, the foot 18 is allowed to rotate about the X axis and the Y axis. That is, the ankle joint 26 is a biaxial joint having a degree of freedom for each of the X and Y axes.
[0018]
Each joint is driven by a wire (excluding the rotation of the hip joint around the Z axis. This rotation alone is directly rotated by a motor without using a wire). One end of each wire is attached to the end side member, and the other end is connected to an actuator composed of a ball screw and a motor (the actuator will be described later with reference to FIG. 4). The ball screw feed screw (extending in the Z direction) is rotated by the motor, and the nut screwed to the feed screw is sent in the feed screw direction, and the wire tip connected to the nut is moved in the Z axis direction. Advance and retreat. The distal end member can be pulled or loosened by the wire by advancing and retracting the wire tip in the Z-axis direction.
[0019]
First, a wire group for rotating an ankle joint will be described with reference to FIG. Wire end guides 70a, 70b, 70c are fixed to the foot 18 by a mounting plate (not shown). Each wire end guide 70a, 70b, 70c has an arc shape, the central axis of each arc extends in the Y-axis direction, and the arc surface has a predetermined width (distance extending along the Y-axis). . The wire end guide 70a is located in front of the Y axis of the ankle joint 26 and is disposed on the X axis. The arc surface faces the front of the X axis. The wire end guides 70 b and 70 c are located behind the Y axis of the ankle joint 26. The wire end guide 70 b is located outside the X axis of the ankle joint 26, and the wire end guide 70 c is located inside the X axis of the ankle joint 26. The arcuate surfaces of the wire end guides 70b and 70c face the rear of the X axis.
The lower ends of the three wires 66a, 66b, and 66c are fixed to the wire connection points 72a, 72b, and 72c at the lower ends of the wire termination guides 70a, 70b, and 70c, and the respective wire termination guides 70a, 70b, and 70c are fixed. It is curved along the arc surface. The wire end guides 70a, 70b, and 70c prohibit the wires 66a, 66b, and 66c from bending sharply with a small radius of curvature. The other end of each wire 66a, 66b, 66c extends to the knee joint 24 side.
[0020]
The wire connection point 72a is located in front of the Y axis of the ankle joint 26, and when the wire 66a is pulled toward the knee joint 24, the foot 18 rotates about the Y axis of the ankle joint 26 and lifts the toe. The wire connection point 72a is disposed on the X axis of the ankle joint 26, and even if the wire 66a is pulled toward the knee joint 24, the rotation angle of the foot 18 around the X axis is not affected. The wire connection point 72b is located outside the X axis of the ankle joint 26. When the wire 66b is pulled toward the knee joint 24, the foot 18 rotates around the X axis of the ankle joint 26 and Lift the outside. The wire connection point 72c is located inside the X axis of the ankle joint 26. When the wire 66c is pulled toward the knee joint 24, the foot 18 rotates about the X axis of the ankle joint 26 and Lift the inside. When lifting the inside of the foot 18, the wire 66 c is pulled and the wire 66 b is loosened at the same time to allow the outside of the foot 18 to fall. Similarly, when lifting the outside of the foot 18, the wire 66b is pulled and the wire 66c is loosened to allow the inside of the foot 18 to be lowered. When the foot 18 is rotated about the X axis of the ankle joint 26, it is not necessary to operate the wire 66a. When the wires 66b and 66c are pulled simultaneously, the foot 18 rotates about the Y axis of the ankle joint 26 and lifts the heel. In this case, the wire 66a is loosened to allow the toe to fall. When the toe is lifted by pulling the wire 66a, the wires 66b and 66c are loosened to allow the heel to fall.
With the three wires 66a, 66b and 66c, the rotation angle around the X axis and the rotation angle around the Y axis of the ankle joint 26 can be adjusted independently.
[0021]
In addition, you may arrange | position a wire connection point on the both sides of the X-axis ahead of the Y-axis of the ankle joint 26, and on the X-axis behind the Y-axis. Even when the wire connection points are arranged in this way, the rotation angle around the X axis and the rotation angle around the Y axis of the ankle joint 26 can be independently adjusted by the wire.
[0022]
5 to 10 are schematic diagrams for explaining the movement of the foot 18, and FIGS. 5 and 6 are diagrams for explaining the rotation around the X axis. FIG. 5 is a plan view of the foot 18, and FIG. 6 is a rear view of the foot 18. At the end of each wire 66a, 66b, 66c, illustration of wire end guides 70a, 70b, 70c is omitted, and only wire connection points 72a, 72b, 72c are shown.
[0023]
FIG. 5 shows that the wire (not shown) connected to the wire connection point 72a contracts the effective length of the wire 66b connected to the wire connection point 72b while maintaining a neutral state, and is connected to the wire connection point 72c. The effective length of the wire 66c is extended. At this time, the foot 18 rotates around the X axis in the direction of the arrow as shown by the broken line in FIG. Further, when the extension / contraction of the effective length of the wire is reversed, the foot 18 rotates in the direction opposite to the arrow. That is, by adjusting the extension / contraction of the effective length of the wire in this way, the foot 18 can be freely rotated around the X axis.
[0024]
7 and 8 are diagrams for explaining the rotation around the Y-axis. FIG. 7 is a plan view of the foot 18, and FIG. 8 is a side view of the foot 18. At the end of each wire 66a, 66b, 66c, illustration of wire end guides 70a, 70b, 70c is omitted, and only wire connection points 72a, 72b, 72c are shown. FIG. 7 shows a case where the effective length of the wire 66a connected to the wire connection point 72a is contracted and the effective lengths of the wires 66b and 66c connected to the wire connection points 72b and 72c are both expanded. At this time, the foot 18 rotates around the Y axis in the direction of the arrow as shown by the broken line in FIG. Further, when the extension / contraction of the effective length of the wire is reversed, the foot 18 rotates in the direction opposite to the arrow. Thus, by adjusting the extension / contraction of the effective length of the wire, the foot 18 can be freely rotated around the Y axis.
Note that the wire tension required to lift the rear side of the foot 18 is larger than the wire tension required to lift the front side of the foot 18. For this reason, it is preferable that one of the three wire connection points 72a, 72b, and 72c be the front side, the two points be the rear side, and the heel be lifted by two wires and two actuators. In this case, the capacity of each actuator can be made equal.
[0025]
Although not shown, the foot 18 can be simultaneously rotated about the X axis and the Y axis. For example, when the effective length of the wire 66b is contracted at the speed a−b, the effective length of the wire 66c is expanded at the speed a + b (ie, contracted at −a−b), and the effective length of the wire 66a is contracted at b, The foot 18 rotates around the X axis at a speed a and rises outside, and the leg 18 rotates around the Y axis at a speed b and rises forward. When the effective lengths of the three wires are adjusted at the same time, the foot 18 can be freely rotated around the X axis and the Y axis simultaneously. Further, the rotational speed around the X axis and the rotational speed around the Y axis can be freely adjusted. From these facts, the X and Y axes can be adjusted independently of each other by using three wires for the two axes X and Y, that is, the number of axes + 1.
[0026]
As shown in FIG. 3, three pulleys 64 a, 64 b, 64 c that can freely rotate around a shaft 46 in the Y-axis direction that penetrates the flange 44 are provided on the upper portion of the shaft 42 of the crus 16. And are arranged alternately. One wire 66a, 66b, 66c is wound around each pulley 64a, 64b, 64c. The wires 66a, 66b, and 66c are separated from the pulleys on the front side of the pulleys 64a, 64b, and 64c. The wires 66a, 66b, 66c apply a tensile force to the foot 18 from the front position of the knee joint. Therefore, if the three wires 66a, 66b, 66c are simultaneously contracted at the same speed, the rotation angle of the foot 18 with respect to the crus 16 is not changed (the ankle joint 26 is not rotated), and the crus 16 can be rotated forward around the knee joint 24.
[0027]
Next, the movement of the wire accompanying such movement of the foot will be described. 9 to 10 are schematic diagrams for explaining the movement of the wire accompanying the rotation of the foot 18 and do not necessarily match the actual shape and dimensions. 9 is a rear view of the foot 18 when rotated around the X axis, and FIG. 10 is a left side view of the foot 18 when rotated around the Y axis. It can be assumed that the wire extends in the vertical direction approximately.
[0028]
FIG. 9 is a view showing a state in which the foot 18 is rotated in the direction of the arrow around the X axis of the ankle joint 26 to the maximum (15 ° in this embodiment). A state in which the foot 18 is perpendicular to the shaft 42 of the crus 16 is indicated by a solid line, and the position 18-1 of the foot 18 at this time is a normal position. The foot 18-1 and the wires 66b1 and 66c1 at the normal position and the wire end guides 70b1 and 70c1 for guiding them respectively are indicated by solid lines (the last subscript 1 indicates that it is at the reference position). The foot 18 rotated around the X axis is indicated by a broken line 18-2, and the wires 66b2 and 66c2 and the wire end guides 70b2 and 70c2 at that time are indicated by a broken line (the last subscript 2 indicates that it is in the rotation position). ). The lower end connection points 72b1 and 72c1 of the wires 66b1 and 66c1 are at the center in the Y-axis direction of the lower ends of the wire end guides 70b1 and 70c1, respectively. In the normal position, the wires 66b1 and 66c1 are guided along the center line in the Y-axis direction of the arc surfaces of the wire end guides 70b1 and 70c1. When the foot 18 rotates around the X axis and moves to the position of the foot 18-2, the wires 66b and 66c move to the positions of the wires 66b2 and 66c2 while being guided by the wire end guides 70b and 70c. At this time, the wire end guides 70b2 and 70c2 are inclined with respect to the wires 66b2 and 66c2. The line on the arc surface of the wire end guides 70b2 and 70c2 for guiding the wires 66b2 and 66c2 moves to the line connecting the wire connection portions 72b2 and 72c2 and the upper right end of the wire end guides 70b2 and 70c2 in the drawing. Although not shown, when the wire 66b2 and 66c2 are rotated to the maximum in the direction opposite to the arrow in FIG. 7, the wires 66b2 and 66c2 are connected to the upper left ends of the wire connection portions 72b2 and 72c2 and the wire end guides 70b2 and 70c2, respectively. Move to the connecting line.
[0029]
The width of the wire end guide 70 in the Y-axis direction is set to be greater than the distance at which the distance from the X axis to the wire connection point 72 changes as the foot 18 rotates about the X axis. Even if the portion 18 rotates to the maximum around the X axis, the wire 66 does not come off the wire end guide 70. As described above, according to the wire end guide 70 of this embodiment, it is possible to continue guiding the wire 66 with respect to any posture change around the X axis of the end side member 18.
In the present specification, an event that is described by omitting a subscript indicates that the event is common to members classified by the subscript.
[0030]
FIG. 10 shows a side view when the ankle joint 26 of the present embodiment rotates around the Y axis. In order to contrast with the movement of the wire in the present embodiment, the movement of the wire when the wire end guide 70 is not provided will be described first with reference to FIG.
[0031]
In the absence of a wire termination guide, the ankle joint 226 is moved around the Y axis 262 by a wire 266 attached to the front (left side of the figure) of the universal joint Y axis 262 and a wire attached to the rear (not shown). Rotated. The lower end of each wire is fixed to a wire connecting portion 272 (the connection point of the rear wire is not shown) on the upper surface of the foot 218, and the upper end is connected to an actuator (not shown). The effective length of each wire is extended and contracted by the actuator, and the foot 218 is rotated about the Y axis 262. It can be assumed that the wire extends in the vertical direction approximately.
[0032]
The broken line in FIG. 11 indicates that the foot 218 has been rotated to the maximum in the directions of arrows III and IV around the Y axis 262 of the ankle joint 226. A normal position where the angle formed by the shaft 242 of the foot 218 and the lower leg 216 is a right angle is indicated by a solid line (subscript 1 indicates that it is in the normal position). At this time, an angle α formed by the foot 218-1 and the wire 266-1 is also a right angle. The foot 218-3, the wire 266-3, and the wire connecting portion 272-3 after rotation in the direction of the arrow III (clockwise in the figure) are indicated by a broken line and indicated by the subscript 3. The foot 218-4, the wire 266-4, and the wire connecting portion 272-4 after rotation in the direction of arrow IV (counterclockwise in the figure) are indicated by a broken line and indicated by a subscript 4. The angle β formed between the foot 218-3 rotated in the direction of arrow III and the wire 266-3 is larger than α in the normal position, and the foot 218-4 rotated in the direction of arrow IV and the wire 266-4 are The formed angle γ is smaller than α at the normal position. That is, the angle formed by the foot 218 and the wire 266 changes as the foot 218 rotates. In the method in which the wire guide is not provided in FIG. 11, the wire 266 is bent sharply at the connection point 272, so that the wire 266 is easily cut at the connection point 272.
[0033]
Further, when the foot portion 218 rotates around the Y axis, the wire connecting portion 272 on the upper surface of the foot portion 218 also rotates accordingly. The horizontal distance La between the Y axis 262 and the wire connection point 272-3 when rotated in the direction of arrow III is larger than the normal position, and the Y axis 262 and wire connection point 272-4 when rotated in the direction of arrow IV. The horizontal distance Lb is smaller than the normal position. The distances La and Lb are arm lengths that are directly linked to the magnitude of the moment that rotates the foot 218 about the Y axis 262. If the tension applied to the wire is the same, the longer the arm length, the greater the moment.
In the system in which the wire guide is not provided in FIG. 11, the arm length changes greatly depending on the posture of the foot 218, and the magnitude of the moment for rotating the foot 218 changes greatly.
[0034]
On the other hand, FIG. 10 shows the ankle joint 26 and the wire end guide 70 of this embodiment. The foot 18 is shown rotated about the Y axis 62 of the ankle joint 26 to the maximum (30 ° in this embodiment) in the directions of arrows III and IV. The angle formed by the shaft 18 of the foot 18 and the crus 16 in the standard position is a right angle, and the position of the foot 18-1 at this time is the normal position (subscript 1 indicates that it is in the normal position) ). The foot 18-1 and the wire 66a1 in the normal position and the wire end guide 70a1 for guiding the foot 18-1 are shown by solid lines. Foot 18-3 after rotation in the direction of arrow III (clockwise in the figure), wire 66a3, wire end guide 70a3, connection point 72a3, foot 18- after rotation in the direction of arrow IV (counterclockwise in the figure) 4, the wire 66a4, the wire end guide 70a4, and the connection point 72a4 are indicated by broken lines.
[0035]
As described above, the lower end of the wire 66a attached to the foot portion 18 is fixed to the wire connecting portion 72a at the lower end of the wire end guide 70a. The wire end guide 70a is attached so that the center of the arc is always closer to the lower leg 16 than the wire connecting portion 72a. That is, the vicinity of the lower end of the wire 66a is always guided along the arc surface of the wire end guide 70a.
For this reason, the wire 66a is not locally bent sharply due to the posture change of the foot, and the wire is difficult to cut.
[0036]
As the foot 18 rotates around the Y axis 62, the guide portion of the wire 66a by the arc surface of the wire end guide 70a changes as follows. In the normal position, the wire 66a1 is guided from the lower end of the arc surface of the wire end guide 70a1 to a position with a central angle of 90 °. When rotated in the direction of arrow III, the wire 66a3 is guided to a position about one third from the lower end of the arc surface of the wire end guide 70a3. When rotated in the direction of arrow IV, the wire 66a4 is guided from the lower end of the arc surface of the wire end guide 70a4 to the vicinity of the upper end. That is, even when the foot 18 rotates, the length of the wire 66a guided by the wire end guide 70a changes, so the horizontal distance to the point where the wire 66a is separated from the wire guide 70a and the Y axis 62 is substantially constant. To be kept.
As a result, in the system having the wire end guide 70 of FIG. 10, even if the foot 18 changes its posture, the change in the arm length is small, and the change in the moment that rotates the foot 18 is also small.
If the center of the arc of the wire end guide is provided at a position higher than the foot 18, that is, a position close to the body side member 16, the vicinity of the end of the wire is always guided by the wire guide, and the arm of the moment The change in length can be kept small.
[0037]
Without the wire end guide, every time the end side member such as the foot moves, the wire locally bends at the wire connecting portion, so it is not easy to maintain the durability of the wire connecting portion. In this embodiment, since the wire end guide is provided, even if the foot rotates around the Y axis, the vicinity of the lower end of the wire is always guided by the arc surface of the wire end guide. There is no local bending, and the durability of the wire connection portion is improved.
Further, if there is no wire end guide, the distance between the wire and the Y axis, that is, the arm length of the moment greatly changes every time the end side member such as the foot moves. In this embodiment, since the wire end guide is provided, even if the foot rotates around the Y axis, the change in the arm length of the moment can be suppressed by the wire end guide.
Further, the wire end guide of this embodiment has a width in the Y-axis direction, and the wire does not come off the wire end guide even if the foot 18 rotates around the X axis.
[0038]
In this embodiment, by using the wire end guide, the durability of the wire connecting portion can be maintained against changes in the posture of the end side member around the X axis and the Y axis. In addition, a change in the arm length of the moment can be suppressed with respect to a change in the posture of the terminal side member around the X axis and the Y axis. Furthermore, since the wire end guide is made wider, the wire can always be guided near the wire connection point without deviating from the wire end guide.
Even in a system in which a wire is guided by forming a groove in the wire end guide, the wire can be prevented from deviating from the wire end guide, but the wire may be locally bent sharply when the wire is separated from the groove. The wire end guide of this embodiment does not have a groove, so that the wire can move freely in the axial direction on the arc surface of the wire end guide and is wide so as not to deviate. It has succeeded in always guiding while avoiding sharp bending.
[0039]
The upper ends of the three wires 66a, 66b, 66c clearly shown in FIG. 3 are connected to ball screws 68a, 68b, 68c (see FIGS. 1 and 2). In FIG. 1 and FIG. 2, the ball screw is shown in a simplified manner for clarity of illustration. FIG. 4 schematically shows the details of the ball screw 68 (all ball screws have the same structure, and are therefore described in common by omitting suffixes), and a pair of flanges 102 and 106 are provided with three pieces. The guide rods 108, 110, and 112 are connected. A feed screw 120 is rotatably disposed between the pair of flanges so as not to move in the axial direction. The feed screw 120 is rotated by a motor 114, a gear 116, and a gear 118. The movable plate 104 is screwed to the feed screw 120. The movable plate 104 is guided by the guide rods 108, 110, and 112 and can move in the axial direction but cannot rotate. The tip of the wire 66 is fixed to the movable plate 104.
When the motor 114 rotates, the feed screw 120 rotates and the movable plate 104 slides along the guide rod, and the wire 66 is drawn or loosened.
The motor of the ball screw 68 is 114 and the pair of flanges 102 and 106 are fixed to the thigh 14. The guide rods 108, 110 and 112 extend in the longitudinal direction of the thigh 14, and the motor 114 rotates the ball screw 68 so that the wire 66 is pulled or loosened in the longitudinal direction of the thigh 14. Or
When the distance between the pulleys 64a, 64b, and 64c of the wires 66a, 66b, and 66c and the connection points 72a, 72b, and 72c is the effective length of the wire, the effective length of the wires 66a, 66b, and 66c is extended by the motor 114. An actuator group (consisting of a motor group and ball screw groups 68a, 68b, and 68c) that extends the effective length of the wires 66a, 66b, and 66c is disposed on the thigh 14 near the hip joint 22.
[0040]
As shown in FIG. 4, the controller 200 is connected to the ball screw 68. The controller 200 includes a first calculation unit 200a, a second calculation unit 200b, and a third calculation unit 200c. The controller 200 is input with a signal indicating the rotation angle of the ankle joint 26 and the tension of each wire 66a, 66b, 66c from another controller (not shown) that controls the entire movement of the robot 10.
The first calculation unit 200a of the controller 200 calculates the effective length of each of the wires 66a, 66b, and 66c using the rotation angle of the ankle joint 26 as an input value. The second calculation unit 200b calculates the extension length of each of the wires 66a, 66b, and 66c so that the tension becomes the input value. The third calculator 200c calculates the amount of operation of the movable plate 104 of the ball screw 68 from the calculation results of the first calculator 200a and the second calculator 200b. The calculated operation amount of the movable plate 104 is output to the ball screw 68, and the ball screw 68 operates according to this output.
[0041]
As shown in FIG. 2, one end of a wire 66 d that rotates the lower leg part 42 around the knee joint 24 backward is connected to the lower leg part 42. The wire 66d is connected to the movable plate 104 of the ball screw 68d through the rear of a pulley 64d (see FIG. 1) that is rotatably arranged at the knee joint. The movable plate 104 of the ball screw 68d is advanced and retracted by a motor. When the movable plate 104 advances and retreats, the wire 66d is drawn or loosened.
[0042]
As described above, the following posture change is realized.
(1) The tip of the toe is raised by shrinking the ball screw 68a and loosening the ball screws 68b and 68c. The tip of the toe is lowered by loosening the ball screw 68a and shrinking the ball screws 68b and 68c.
(2) The outer side of the foot is raised by shrinking the ball screw 68b and loosening the ball screw 68c. The inner side is raised by loosening the ball screw 68b and shrinking the ball screw 68c.
(3) The crus 16 rotates forward by shrinking the ball screws 68a, 68b, 68c and loosening the ball screw 68d. By loosening the ball screws 68a, 68b, 68c and shrinking the ball screw 68d, the lower leg 16 rotates backward.
With the four actuators and four wires, the rotation angle of the ankle joint 26 around the X axis (2 rotation), the rotation angle of the ankle joint 26 around the Y axis (1 rotation), and the knee joint 24 The rotation angle of rotation (the rotation of 3) can be adjusted independently.
In order to adjust the rotation angle around three axes with four actuators, the actuators appear redundant. However, the rigidity relating to the rotation angle can be adjusted using this redundancy. This point will be described later.
[0043]
Since not only the knee joint 24 but also the actuator for adjusting the rotation angle of the ankle joint 26 is disposed on the thigh 14, the tip of the artificial lower limb is light and the moment of inertia around the hip joint is small. For this reason, a lower limb that can be rotated at high speed around the hip joint 22 with a small torque is obtained.
[0044]
Next, the wire and actuator for adjusting the rotation angle around the hip joint 22 will be described. As shown in FIGS. 1 and 2, three arc-shaped wire terminal guides 48a, 48b, and 48c are attached to predetermined positions on the upper portion of the thigh 14 at three locations, and the wires 50a, 50b, and 50c are respectively provided. Are hung one by one. The lower ends of the wires 50a, 50b, and 50c are fixed to the lower ends 49a, 49b, and 49c of the wire termination guides 48a, 48b, and 48c, respectively. A pulley 54 is disposed in the middle of the wire 50 c attached to the rear side, and the pulley 54 is located behind the Y axis of the hip joint 22. The upper ends of the wires 50a, 50b, and 50c are connected to the movable plates of the ball screws 52a, 52b, and 52c, respectively. Since the feed screws of the ball screws 52a and 52b are respectively rotated by a motor (not shown), the movable plate screwed to the feed screw is advanced and retracted by the rotation of the motor. As a result, the effective lengths of the wires 50a, 50b, and 50c expand and contract. The ball screws 52a, 52b, 52c and the motor 56 for the ball screws 52a, 52b, and 52c are disposed on the trunk, and do not increase the moment of inertia of the lower limbs rotating around the hip joint 22.
[0045]
The ball screws 52a and 52b are positioned in front of the Y axis of the hip joint 22, and when contracted, the thigh 14 is rotated forward around the Y axis of the hip joint 22. The pulley 54 that guides the wire 50c is located rearward of the Y axis of the hip joint 22. When the ball screw 52c contracts, the thigh 14 is rotated rearward around the Y axis of the hip joint 22. Note that the disc 36 that is rotatable on the pelvic part 28 is rotated around the Z axis by a motor 38. The motor 38 is fixed to the pelvis 28.
[0046]
The wire connection point 49 c is located behind the Y axis of the hip joint 22, and when the wire 50 c is pulled, the thigh 14 rotates rearward around the Y axis of the hip joint 22. The wire connection point 49c is disposed on the X axis of the hip joint 22, and even if the wire 50c is pulled, the rotation of the thigh 14 around the X axis is not affected. The wire connection point 49a is located outside the X axis of the hip joint 22, and when the wire 50a is pulled, the thigh 14 rotates about the X axis of the hip joint 22 and opens the thigh 14. The wire connection point 49b is located inside the X axis of the hip joint 22, and when the wire 50b is pulled, the thigh 14 rotates around the X axis of the hip joint 22 and closes the thigh 14. When closing the thigh 14, the wire 50b is pulled and the wire 50a is loosened simultaneously to allow the thigh 14 to be closed. Similarly, when opening the thigh 14, the wire 50 a is pulled and simultaneously the wire 50 b is loosened to allow the thigh 14 to open. When the thigh 14 is rotated around the X axis of the hip joint 22, it is not necessary to operate the wire 50c. When the wires 50a and 50b are pulled simultaneously, the thigh 14 rotates forward around the Y axis of the hip joint 22 to lift the thigh 14. In this case, the wire 50c is loosened to allow the thigh 14 to rotate forward. When pulling the wire 50c and rotating the thigh 14 backward, the wires 50a and 50b are simultaneously loosened to allow the thigh to descend.
[0047]
As described above, the hip joint 22 is adjusted as follows.
(1) The thigh 14 rotates backward by shrinking the ball screw 52c and loosening the ball screws 52a and 52b. The thigh 14 rotates forward by loosening the ball screw 52c and shrinking the ball screws 52a and 52b. A large torque is required to lift the thigh 14 forward, whereas a large torque is not required to lower the thigh 14 backward. Two actuators and two wires are used on the side where a large torque is required, and one actuator and one wire are used on the side where only a small force is required.
(2) The thigh 14 is lifted outward by shrinking the ball screw 52a and loosening the ball screw 52b. The thigh 14 is closed by loosening the ball screw 52a and shrinking the ball screw 52b.
With the three actuators and the three wires, the rotation angle of the hip joint 22 around the X axis (the second rotation) and the rotation angle of the hip joint 22 around the Y axis (the first rotation) can be adjusted independently.
[0048]
Since the actuator for moving the thigh 14 around the hip joint 22 is arranged on the body side, it is not necessary to move each actuator when moving the thigh 14. The moment of inertia around the hip joint 22 is small. For this reason, it is possible to rotate the lower limbs around the hip joint 22 at a high speed with a small torque.
[0049]
A spring 140 shown in FIGS. 12 and 13 is inserted in an intermediate portion between the three wires 66a, 66b, and 66c clearly shown in FIG. The spring 140 is made of spring steel and includes a flat plate portion 122, a pair of flanges 126, 126, and another pair of flanges 130, 130. A shaft 128 is passed between the flange pairs 126, 126, and a shaft 132 is passed between the flange pairs 130, 130. The flat plate portion 122 has a ridge portion 124 extending in parallel with the shafts 128 and 132. The wire 66 passes below the shaft 128, above the peak portion 124, and below the shaft 132 while being bent.
As shown in FIG. 14, when the wire 66 is pulled strongly, the flat plate portion 122 made of spring steel is bent and the wire 66 is stretched.
[0050]
Since the spring 140 is inserted into the wire, the wire tension can be adjusted by a ball screw.
In FIG. 1, it is assumed that the retracted amount of the ball screw 68b is equal to the retracted amount of the ball screw 68c, and the foot 18 is adjusted to be perpendicular to the shaft 42 of the crus 16 around the X axis. It is assumed that the ball screw 68b and the ball screw 68c are further pulled at the same speed from this state. In this case, since the wire 66b and the wire 66c are drawn at the same speed, the foot 18 does not rotate around the X axis. However, as the wires 66b and 66c are pulled, the spring 140 is deformed as shown in FIG. 14, and the tension of the wires 66b and 66c increases. That is, since this robot is a system in which one of the two wires is pulled and rotated in the clockwise direction, and the other wire is pulled and rotated in the counterclockwise direction, the rotation angle is obtained by pulling in both wires at the same time. Only the wire tension can be increased without changing. Similarly, by loosening both wires simultaneously, only the wire tension can be reduced without changing the rotation angle.
[0051]
The wire tension determines the stiffness of the rotation angle around the joint. For example, when the foot 18 in FIG. 1 is in contact with the ground, if the tension of both wires is weak and the rigidity is low, if the grounded ground is high on the left side of the foot and low on the right side, the right side of the foot 18 is The pulled wire extends and the foot 18 inclines following the inclination of the ground, so that the entire foot 18 is grounded. If the stiffness is low, it can flexibly follow external events.
On the other hand, when the foot 18 on one side is in the air, if the tension of both wires to be adjusted to the air posture is low and the rigidity is low, the wire is stretched by a slight external force acting on the robot, so the air posture is It becomes unstable. In order to stabilize the posture, higher rigidity is preferable. When the rigidity is higher, the movement of the ball screw and the rotation angle around the joint match well, and the rotation or operation around the joint can be performed at high speed.
[0052]
The robot of this embodiment is a system (pull-pull system) in which one of the two wires is pulled and rotated in the clockwise direction, and the other wire is pulled and rotated in the counterclockwise direction. Since a non-linear spring is inserted, the rigidity can be adjusted independently of the robot posture. When it is necessary to follow flexibly, the rigidity is low, and when it is necessary to stabilize the posture, the rigidity can be adjusted to high rigidity.
[0053]
The reason why the rigidity around the joint can be adjusted by the pull-pull method and the nonlinear spring will be described with reference to FIGS. In this description, a simple example in which the foot is rotated around the Y axis by two wires will be described. FIG. 21 schematically illustrates such a configuration. As shown in FIG. 21, the foot 302 is integrated with a cylindrical pulley 303. The pulley 303 is rotatably supported around the Y axis 303c. The front wire 304 and the rear wire 306 are wound around a pulley 303, and one end of each is connected to the pulley 303 at wire connection points 303a and 303b. The other ends of the front wire 304 and the rear wire 306 are connected to the front actuator 312 and the rear actuator 314, respectively. The front actuator 312 and the rear actuator 314 are fixed to the fixing members 322 and 324. The actuators 312 and 314 pull in and loosen the wires 304 and 306. A front nonlinear spring 305 and a rear nonlinear spring 307 are attached in the middle of the wires 304 and 306.
[0054]
FIG. 22 is a graph showing the spring characteristics of the front nonlinear spring 305 and the rear nonlinear spring 307. The vertical axis (y-axis) indicates the spring force, and the horizontal axis (x-axis) indicates the amount of spring extension. The curve on the right side of the y axis represents the spring characteristic of the rear nonlinear spring 307, and the left side of the y axis represents the spring characteristic of the front nonlinear spring 305. As is apparent from FIG. 22, the spring characteristics of the front nonlinear spring 305 and the rear nonlinear spring 307 have nonlinearity in which the spring force suddenly increases (the curve slope becomes steep) as the elongation increases. . That is, it does not follow Hooke's law.
The manner in which the rigidity of the foot 302 around the rotation shaft 303c is adjusted will be specifically described with reference to FIG. For example, it is assumed that the actuators 312 and 314 are further pulled by A (mm) from the operation amount of the actuators 312 and 314 when the extension amounts of the springs 305 and 307 are zero and the angle of the foot 302 is adjusted to a predetermined position. Then, the springs 305 and 307 are extended and a spring force of B (kg) is generated (see points D and F). The wire tension is adjusted to B (kg). Since the front wire 304 and the back wire 306 have the same tension, the foot 302 does not rotate and remains in the adjusted position. In this state, it is assumed that a clockwise moment is applied to the foot 302 to rotate it, and the rear spring 307 extends C (mm) (point D → point E). On the other hand, when the rear spring 307 is extended by C (mm), the front spring 305 is contracted (point F → point G) by the same amount (C (mm)). Therefore, in order to rotate the foot 302 and expand and contract the springs (305, 307) by C (mm), it is necessary to apply a force of H (kg), which is the difference between the spring force at the point E and the point G, to the pulley 303. There is.
[0055]
It is assumed that the actuators 312 and 314 are further retracted by J (mm) (point L and point M). At this time, the spring force generated by the springs 305 and 307 is K (kg). Even in this case, since the tensions of the wires 304 and 306 are equal, the foot portion 302 maintains its position without rotating. In this state, it is assumed that a clockwise moment is applied to the foot 302 and the rear spring 307 extends C (mm) (point L → point N). The front spring 305 contracts by C (mm) (point M → point P). Therefore, in order to rotate the foot 302 and expand and contract the springs 307 and 305 by C (mm), it is necessary to apply a force of Q (kg), which is a difference between the spring forces at the points N and P, to the pulley 303. .
[0056]
The force required to expand and contract the springs 307 and 305 by C (mm) from the state of the tension B realized by the actuators 312 and 314 being pulled in by A (mm) is H (kg). The force required to expand and contract the springs 307 and 305 by C (mm) from the state of the tension K realized by the actuators 312 and 314 being pulled in by J (mm) is Q (kg). Clearly, Q (kg) is larger than H (kg). That is, when the actuators 312 and 314 are largely pulled to generate a large tension on the wires 304 and 306, the rigidity of the foot 302 (the rotational moment about the Y axis required to rotate the foot 302 by a predetermined angle) ) Will be higher. By changing the amount by which the actuators 312 and 314 pull the wires 304 and 306, the rigidity of the foot 302 can be adjusted.
When combined with a pull-pull system and a non-linear spring, the rigidity can be adjusted independently of the rotation angle of the joint.
[0057]
The inclination angle of the spring characteristic graph of FIG. 22 is proportional to the rigidity. Therefore, by obtaining the amount of elongation of the spring whose inclination angle corresponds to the intended stiffness and giving the amount of elongation, the desired stiffness can be adjusted.
Regardless of the posture of the robot, if the length of the perpendicular line from the center of rotation to the wire, that is, the length of the arm of the moment is substantially constant, the tension or the extension amount can be determined from the rigidity.
However, if the length of the perpendicular line from the center of rotation to the wire, that is, the length of the moment arm changes, the length of the moment arm must be taken into account before determining the tension from the stiffness. . For example, it is assumed that the wire tension is 1 kg. At this time, the length from the center of rotation to the point of application of the 1 kg tension is 10 cm (case 1) and 20 cm (case 2). At this time, the case 2 has a longer arm length and a larger moment. Case 2 has a stronger degree of maintaining the joint rotation angle at a predetermined value against an external force while having the same tension. Stiffness is determined by the length of the arm of tension and moment.
When the stiffness is specified, the second calculation unit of the controller calculates the tension necessary to adjust the specified stiffness from the specified stiffness and the length of the arm of the moment at that moment, and then When the length of the wire elongation necessary for adjusting to the tension is calculated, the flexibility around the joint can be adjusted to the specified rigidity regardless of the posture of the robot.
[0058]
The robot of the present invention is wire-driven, and there is no need to mount an actuator on each joint. Since the actuator can be mounted at a position away from the joint, the joint can be reduced in size and weight, and the degree of freedom in mounting the actuator is increased. In the case of the present invention, the number of wires may be three for a biaxial joint, four for a triaxial joint, that is, the number of axes plus one for one joint. Since the required number of wires and the number of actuators are reduced, the limbs and the like can be slimmed and reduced in weight.
[0059]
In the present embodiment, a wire end guide is disposed in the vicinity of the connection point between the end side member and the wire. The wire end guide guides the wire on an arc surface, the arc surface is wide in the axial direction, and the center of the arc is always closer to the body side member than the wire connection point. According to such a wire end guide, the durability of the wire connection portion is maintained against any posture change of the end side member, the change in the arm length of the moment is suppressed, and the wire deviates from the wire end guide. In addition, the vicinity of the wire connection point can always be guided. By these things, a joint, limbs, etc. can be reduced in size and weight. Further, the power required to change the posture is reduced, and the movement of the distal side member can be speeded up. Furthermore, the wire drive mechanism can be stabilized, and a robot similar to humans and animals can be realized in terms of appearance and operation.
The structure of rotating a joint by pulling with a wire is very similar to the structure of a living body that rotates a limb or neck around the joint with a muscle. Suitable for realizing a robot.
[0060]
Specific examples of the present invention have been described in detail above, but these are merely examples and do not limit the scope of the claims. The technology described in the claims includes various modifications and changes of the specific examples illustrated above.
In addition, the technical elements described in the present specification or the drawings exhibit technical usefulness alone or in various combinations, and are not limited to the combinations described in the claims at the time of filing. In addition, the technology illustrated in the present specification or the drawings achieves a plurality of objects at the same time, and has technical utility by achieving one of the objects.
[Brief description of the drawings]
FIG. 1 is a front view of both lower limbs of a robot according to an embodiment.
FIG. 2 is a side view of the left lower limb of the robot.
FIG. 3 is a view for explaining a structure of an ankle joint of the robot.
FIG. 4 is a diagram for explaining details of a ball screw of the robot.
FIG. 5 is a view for explaining a movement of a foot portion of the robot.
FIG. 6 is a view for explaining the movement of the foot of the robot.
FIG. 7 is a view for explaining the movement of the foot of the robot.
FIG. 8 is a view for explaining the movement of the foot of the robot.
FIG. 9 is a view for explaining the movement of the foot of the robot.
FIG. 10 is a view for explaining the movement of the foot of the robot.
FIG. 11 is a diagram for explaining the movement of a foot portion of a conventional wire-driven robot.
FIG. 12 is a front view of a spring inserted into the wire of the robot according to the present embodiment.
FIG. 13 shows a cross-sectional view of a spring inserted into the wire of the robot.
FIG. 14 shows a front view when a spring to be inserted into the wire of the robot is extended.
FIG. 15 is a view for explaining joint rigidity of the robot;
FIG. 16 is a graph for explaining joint rigidity of the robot;
[Explanation of symbols]
10: Robot
12: Lower limb
14: Thigh
16: Lower leg
18: Foot
20: trunk
22: Hip joint
24: Knee joint
26: Ankle joint
28: Pelvis
30: Shaft
32: Universal joint
34: Bearing
36: Disc
38: Actuator
40: Flange
42: Shaft
44: Flange
46: axis
48a, 48b, 48c: wire end guides
49a, 49b, 49c: wire connection points
50a, 50b, 50c: wire
52a, 52b, 52c: Ball screw
54: Pulley
56: Actuator
58: Flange
60: Flange
62: Cross-shaped universal joint
64a, 64b, 64c, 64d: pulley
66a, 66b, 66c, 66d: wire
68a, 68b, 68c, 68d: Ball screw
70a, 70b, 70c: wire termination guide
72a, 72b, 72c: wire connection points
102: Flange
104: Movable plate
106: Flange
108: Guide rod
110: Guide rod
112: Guide rod
114: Motor
116: Gear
118: Gear
120: Lead screw
122: Flat plate part
124: Minebe
126: Flange
128: Shaft
130: Flange
132: Shaft
302: Foot
303: pulley, 303a: wire connection point, 303b: wire connection point, 303c: Y axis
304: Front wire
305: Front spring
306: Rear wire
307: Back spring
312: Front actuator
314: Rear actuator
322, 324: fixing member

Claims (3)

A body side member;
A distal member;
A multi-axis joint that connects the body side member and the end side member rotatably around the X axis and the Y axis orthogonal to the X axis;
It is fixed to the end side member, and its central axis extends in the Y-axis direction and has an arc surface having a predetermined width in the Y-axis direction, and is located on one side of the multiaxial joint in the X-axis direction. A first wire termination guide,
A first wire having a terminal end connected to the first wire terminal guide and a part of the first wire terminal guide guided by the arc surface of the first wire terminal guide;
A first actuator that advances and retracts the other end of the first wire;
It is fixed to the end side member, and its central axis extends in the Y-axis direction and has an arc surface having a predetermined width in the Y-axis direction, and is located on the other side of the multiaxial joint in the X-axis direction. And a second wire end guide located on one side of the multi-axis joint with respect to the Y-axis direction ,
A second wire, the end of which is connected to the second wire end guide, and a part of the length extending from the end is guided by the arc surface of the first wire end guide;
A second actuator for advancing and retracting the other end of the second wire;
It is fixed to the end side member, and its central axis extends in the Y-axis direction and has an arc surface having a predetermined width in the Y-axis direction, and is located on the other side of the multiaxial joint in the X-axis direction. And a third wire end guide located on the other side of the multiaxial joint with respect to the Y-axis direction ,
A third wire, the end of which is connected to the third wire end guide, and a portion extending from the end over a certain length is guided by the arc surface of the third wire end guide;
A third actuator for advancing and retracting the other end of the third wire ;
Ru equipped with a robot. The arc surface of the first wire end guide faces the one side with respect to the X-axis direction,
2. The robot according to claim 1, wherein an arc surface of the second wire end guide and an arc surface of the third wire end guide face the other side in the X-axis direction. The center axis of the arc surface of the first wire end guide is closer to the body side member than the connection point where the end of the first wire is connected, and the center axis of the arc surface of the second wire end guide is the end of the second wire It is characterized in that it is closer to the body side member than the connected connection point, and the center axis of the arc surface of the third wire end guide is closer to the body side member than the connection point to which the end of the third wire is connected. The robot according to claim 1 or 2.

Images