JP4043839B2 - robot - Google Patents

Description

[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a robot. In particular, the present invention relates to a technique for moving the lower limbs and upper limbs of humanoid robots and animal robots.
[0002]
[Prior art]
The development of humanoid and animal robots with lower and upper limbs has become active. The lower limbs and upper limbs of such robots have joints, and they walk, hold, and operate by rotating the joints.
The rotation of the joint is performed by a motor attached to the shaft. A motor is attached to each axis of the joint. For example, since the ankle joint rotates about two axes, two motors are attached to the ankle joint.
[0003]
[Problems to be solved by the invention]
However, since the above-mentioned robot has a motor attached to each axis of the joint, the moment of inertia of the lower limb and the upper limb is increased. For example, when two motors are attached to the ankle joint, a heavy motor is disposed at a position far from the hip joint, so that the moment of inertia around the hip joint increases. When the moment of inertia is large, a large force is required to move the lower limb and the upper limb.
[0004]
The present invention has been made to solve such a problem, and an object thereof is to provide a technique capable of moving a lower limb and an upper limb of a robot with a small force.
[0005]
[Means for solving the problem, operation and effect]
The robot of the present invention includes a thigh, a lower leg connected to the thigh via a knee joint, a foot connected to the lower leg via an ankle joint, and a thigh A lower leg actuator that rotates the lower leg, and first and second foot actuators that rotate the foot relative to the lower leg, and the actuator group includes the thigh Installed on .
When the actuator group is fixed to the thigh, the tip of the lower limb (foot, ankle joint, lower leg, etc.) is lightened, and the moment of inertia around the hip joint is reduced. For this reason, the lower limb can be moved with a small force.
[0006]
In the robot described above, the lower leg actuator and the lower leg are connected by a wire, and the foot actuator and the foot are connected by a wire passing through the periphery of the knee joint. each is Ru Oh an actuator for driving the joint by adjusting the length of the wire.
With this configuration, when the lower leg actuator pulls the wire, the lower leg rotates with respect to the thigh, and when the foot actuator pulls the wire, the foot moves with respect to the lower leg. It is rotated. The power is transmitted to the distal member by a wire, and it is not necessary to provide an actuator for rotating the distal member on the distal member.
[0007]
In the above robot, the knee joint is connected to the thigh so that the lower leg can rotate about the rotation axis extending in the left-right direction of the robot, and the ankle joint connects the foot to the lower leg. it is rotatably connected to the rotation axis extending in the lateral direction of the robot.
Further, in the above robot, the lower leg actuator and the lower leg are connected by a lower leg wire passing through the rear side of the knee joint, and the first leg actuator and the foot located on the front side of the ankle joint the front portion are connected by a first wire you pass the knee joint front, second rear foot portion located on the rear side of the actuator and the ankle joint for the second leg portion you pass the knee joint front Connected with wires, loosen the lower leg wire connected to the lower leg with the lower leg actuator and pull both the first and second wires with the first and second foot actuators it rotates toward the front of the robot with respect in the lower leg portion thigh.
In the robot described above, the lower leg actuator and the lower leg are connected by the lower leg wire, and the wire is pulled backward. Further, by adjusting the manner of pulling the first and second wires, the front part or the rear part of the foot part can be pulled upward, and the lower leg part can be pulled forward.
[0009]
On the other hand, in the above robot, the knee joint is connected to the thigh so that the lower leg can rotate about the rotation axis extending in the left-right direction of the robot, and the ankle joint is connected to the lower leg. May be connected so as to be rotatable around two axes of a rotation axis extending in the left-right direction of the robot and a rotation axis extending in the front-rear direction.
At this time, the robot is connected to the lower leg actuator and the lower leg by a lower leg wire passing through the rear side of the knee joint, and is positioned on the front side and the outer side of the first leg actuator and the ankle joint. front outer foot which are connected by a first wire you pass the knee joint front, the front inner leg portion located on the front side and the inner side of the third foot actuator and ankle joint the knee joint It is connected by a third wire passing through the front side, and the second foot actuator and the rear part of the foot located on the rear side of the ankle joint are connected by a second wire passing through the front side of the knee joint. Loosen the lower leg wire connected to the lower leg with the thigh actuator, and pull the first, second and third wires together with the first, second and third foot actuators. The thigh is facing the front of the robot with respect to the thigh Rotating is preferable.
In the above robot, the lower leg actuator is connected to the lower leg with a wire passing through the rear side of the knee joint, and the lower leg is pulled backward. Also, by adjusting how the first, second, and third wires are pulled, the front outside of the foot, the inside of the front of the foot, the rear of the foot, and the front of the foot You can also pull the lower leg part forward.
In the above robot, three actuators are used to lift the lower leg where a large force is required, and one actuator is used to move the lower leg that requires less force. Therefore, it is easy to equalize the actuator capacity.
[0011]
DETAILED DESCRIPTION OF THE INVENTION
A first 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 crus or torso extends is the Z-axis. Each axis is orthogonal to each other.
In the first 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.
[0012]
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.
[0013]
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.
[0014]
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.
[0015]
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 allows the foot 18 to rotate about the X axis and the Y axis with respect to the crus 24. That is, the ankle joint 26 is a biaxial joint having a degree of freedom for each of the X and Y axes.
[0016]
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 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.
[0017]
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, 66c are fixed to the wire connection points 72a, 72b, 72c at the lower ends of the wire termination guides 70a, 70b, 70c, and the other ends of the wires 66a, 66b, 66c. Extends to the knee joint 24 side. The wire end guides 70a, 70b, and 70c are curved along the arcuate surfaces. The wire end guides 70a, 70b, and 70c prohibit the wires 66a, 66b, and 66c from bending sharply with a small radius of curvature.
[0018]
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.
[0019]
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.
[0020]
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.
[0021]
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.
[0022]
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.
[0023]
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.
[0024]
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.
[0025]
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.
[0026]
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.
[0027]
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.
[0028]
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.
[0029]
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.
[0030]
The broken line in FIG. 11 indicates that the foot 218 has been rotated to the maximum extent 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 the arrow IV (counterclockwise in the figure) are indicated by a broken line and indicated by the 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.
[0031]
Further, when the foot part 218 rotates around the Y axis, the wire connection part 272 on the upper surface of the foot part 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.
[0032]
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 the present 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.
[0033]
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.
[0034]
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.
[0035]
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.
[0036]
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.
[0037]
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.
[0038]
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.
[0039]
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.
[0040]
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.
[0041]
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.
[0042]
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.
[0043]
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.
[0044]
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.
[0045]
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.
[0046]
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.
[0047]
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.
[0048]
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.
[0049]
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 extended 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.
[0050]
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. In addition, since a spring extending in proportion to the tension is inserted, the rigidity can be adjusted independently of the robot posture. When it is necessary to follow flexibly, the rigidity is sometimes low, and when it is necessary to stabilize the posture, the rigidity can be adjusted to be high.
[0051]
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.
[0052]
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.
[0053]
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 does not rotate and maintains its position. 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. .
[0054]
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.
[0055]
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.
[0056]
A second embodiment in which the present invention is embodied in a neck joint will be described with reference to FIGS. FIG. 15 is a view for explaining the structure of the neck joint of the robot, and FIGS. 16 to 20 are views for explaining the movement of the head.
[0057]
FIG. 15 is a deformed view for explaining the structure of the neck joint 80, and does not necessarily match the actual shape and dimensions. The neck joint 80 connects the head 82 and the clavicle portion 84 of the body portion 20. A cylindrical flange 86 extends downward from the lower portion of the head 82, and the flange 86 has an axial hole 86a extending in the Z-axis direction. A short shaft 88 is positioned below the head 82, and a shaft 90 extends upward from the short shaft 88. The shaft 90 of the shaft 88 is inserted into the shaft hole 86 a of the flange 86 of the head 82, and the head 82 can be rotated around the Z axis by the shaft 88.
[0058]
Two flanges 92 aligned in parallel with the X-axis direction extend downward at the lower portion of the shaft 88. Further, two flanges 94 arranged in parallel with the Y-axis direction extend upward on the upper surface of the clavicle portion 84. The flange 92 of the shaft 88 and the flange 94 of the collarbone portion 84 are connected by a cruciform universal joint 96 to form a universal joint. The shaft 88 is rotated around the X axis and the Y axis with respect to the collarbone portion 84. They are connected so that they can rotate independently of each other. That is, the neck joint 80 is connected so as to be independently rotatable around the X axis, the Y axis, and the Z axis, and has a degree of freedom for each of the X, Y, and Z axes.
[0059]
Four wires 96a, 96b, 96c, and 96d are stretched between the head portion 82 and the body portion 84 in order to rotate the head portion 82 about the three axes of the X, Y, and Z axes. The upper ends of the four wires 96a, 96b, 96c, 96d are guided by four wire end guides (not shown) attached to the lower part of the head 82, and are fixed to the wire connection points 98a, 98b, 98c, 98d. ing. Long holes 84 a and 84 b are provided in parallel to the flange 94 on both outer sides of the flange 94 of the clavicle portion 84. Below the clavicle portion 84, four pulleys (not shown) are arranged. The wires 96a and 96b pass through the long hole 84a and come out below the clavicle portion 84, and are wound around different pulleys. The wires 96c and 96d pass through the long holes 84b, respectively, and come out below the clavicle portion 84, and are wound around different pulleys. The lower ends of these wires 96a, 96b, 96c, and 96d are connected to an actuator (not shown), and the effective length of the wires is expanded and contracted by the same mechanism as in the first embodiment. The effective length of the wire may be increased or decreased by rotating the pulley with a motor and winding the wire around the pulley.
Of the wire connection points 98a, 98b, 98c, and 98d, 98a and 98b are on the right side of the X axis, and 98c and 98d are on the left side of the X axis. 98b and 98c are located behind the Y axis, and 98a and 98d are located on the front side of the Y axis. The wire connection points 98a, 98b, 98c, and 98d are distributed on both sides of the X axis and the Y axis.
[0060]
Next, the movement of the head 82 due to expansion / contraction of the effective length of the wire will be described. 16 to 20 are schematic diagrams for explaining the movement of the head 82, FIGS. 16 and 17 are diagrams for explaining the rotation around the X axis, and FIGS. 18 and 19 show the rotation around the Y axis. FIG. 20 is a diagram for explaining rotation, and FIG. 20 is a diagram for explaining rotation around the Z axis. 16, 18, and 20 are plan views of the head 82, FIG. 17 is a rear view of the head 82, and FIG. 19 is a left side view of the head 82. The ends of the wires 96a, 96b, 96c, and 96d are omitted from the illustration of the wire end guide, and are shown only by the wire connection points 98a, 98b, 98c, and 98d.
As apparent from FIG. 16, when the connection points 98a, 98b, 98c, and 98d are sequentially viewed around the Z axis in the clockwise direction, the wire group applies a clockwise moment at the connection point 98a and counteracts at the connection point 98b. A clockwise moment is applied, a clockwise moment is applied at the connection point 98c, and a counterclockwise moment is applied at the connection point 98d. That is, the wire groups 96a, 96b, 96c, and 96d are pulled in a direction in which moments about the Z axis are alternately reversed.
[0061]
16 and 17, the effective lengths of the wires 96a and 96b connected to the wire connection points 98a and 98b are contracted equally, and the effective lengths of the wires 96c and 96d connected to the wire connection points 98c and 98d are equally expanded. The case where it was made to show is shown. At this time, the head 82 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 head 82 rotates in the direction opposite to the arrow. That is, by adjusting the extension / contraction of the effective wire length in this way, the head 82 can be freely rotated around the X axis.
[0062]
18 and 19, the effective lengths of the wires 96a and 96d connected to the wire connection points 98a and 98d are equally extended, and the effective lengths of the wires 96b and 96c connected to the wire connection points 98b and 98c are contracted equally. The case where it was made to show is shown. At this time, the head 82 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 head 82 rotates in the direction opposite to the arrow. That is, by adjusting the extension / contraction of the effective wire length in this way, the head 82 can be freely rotated around the Y axis.
[0063]
FIG. 20 shows the wires 96b and 96d connected to the wire connection points 98b and 98d to extend the effective lengths of the wires 96a and 96c connected to the wire connection points 98a and 98c equally to give a counterclockwise moment. The case where effective length is shrunk equally is shown. At this time, the head 82 rotates counterclockwise around the Z axis as shown by the broken line in FIG. When the effective length of the wire is reversed, the head 82 rotates in the clockwise direction. That is, when the extension / contraction of the effective wire length is adjusted in this way, the head 82 can be freely rotated around the Z axis.
[0064]
Although not shown, it is possible to move the head 82 as follows. As shown in FIG. 20, when the effective lengths of the wires 96a and 96c are extended and the effective lengths of the wires 96b and 96d are contracted, the extension amount of the wire 96a and the contraction amount of the wire 96d are equally reduced, and the extension amount of the wire 96c is reduced. When the amount of contraction of the wire 96b and the amount of expansion / contraction of the wire 96b are increased equally, the head rotates to the left in the direction of the arrow about the Z axis, and as shown in FIG. Rotate around the X axis in the direction of the arrow and go up on the left side. Further, if the extension amount of the wire 96a and the contraction amount of the wire 96b are increased equally, the extension amount of the wire 96c and the contraction amount of the wire 96d are decreased equally, and the increase / decrease amount of these extension amount / shrinkage amount is made equal. Like this, it rotates in the direction of the arrow around the Y axis and the front side also rises. That is, by adjusting the extension / contraction of the effective wire length in this way, the head 82 can be freely rotated about the X axis, the Y axis, and the Z axis. By using four wires with respect to the three axes X, Y, and Z, that is, the number of axes + 1, it is possible to adjust the rotation angles independently of each other with respect to the X, Y, and Z axes.
[0065]
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. As a result, the required power can be reduced, so that the movement of the distal side member can be speeded up, and a robot similar to humans and animals in terms of appearance and operation can be realized. It becomes possible.
[0066]
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.
[0067]
Therefore, for example, it can also be configured as described below.
(1) The actuator group is not limited to being arranged on the thigh. For example, an actuator group may be arranged on the upper arm portion of the upper limb, and each actuator may be operated to rotate the forearm relative to the upper arm or rotate the hand relative to the forearm.
[0068]
(2) The ball screw controller described above receives the rotation angle and tension of the joint, but may be configured to input the rigidity of the joint instead of the tension.
In such a configuration, the controller calculates a moment arm between the rotation center of the distal member (for example, the foot) and the connection point of the wire from the rotation angle of the joint, and from this moment arm, the joint has a desired rigidity. Calculate the wire tension. Then, an operation amount of the ball screw having the calculated wire tension is output to the ball screw. In a configuration where the moment arm changes greatly with the rotation of the end side member (a configuration in which there is no wire end guide), the rigidity is input to the controller instead of the tension as described above, and this is processed. Thus, the rigidity of the joint can be controlled more accurately.
[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 diagram illustrating the movement of the foot portion of the robot according to the embodiment.
FIG. 13 is a view for explaining the movement of the foot of the robot.
FIG. 14 is a view for explaining the movement of the foot of the robot.
FIG. 15 is a view for explaining the structure of the neck joint of the robot according to the embodiment.
FIG. 16 is a view for explaining the movement of the head of the robot.
FIG. 17 is a view for explaining the movement of the head of the robot.
FIG. 18 is a diagram for explaining the movement of the head of the robot.
FIG. 19 is a view for explaining the movement of the head of the robot.
FIG. 20 is a view for explaining the movement of the head of the robot.
FIG. 21 is a diagram for explaining the rigidity of a joint of a robot.
FIG. 22 is a graph illustrating the joint stiffness of a robot.
[Explanation of symbols]
10: Robot 12: Lower limb part 14: Thigh part 16: Lower leg part 18: Foot part 20: Torso part 22: Hip joint 24: Knee joint 26: Ankle joint 28: Pelvis part 30: Shaft 32: Universal joint 34: Bearing 36: disk 38: actuator 40: flange 42: shaft 44: flange 46: shafts 48a, 48b, 48c: wire end guides 49a, 49b, 49c: wire connection points 50a, 50b, 50c: wires 52a, 52b, 52c: Ball screw 54: Pulley 56: Actuator 58: Flange 60: Flange 62: Cross type universal joints 64a, 64b, 64c, 64d: Pulleys 66a, 66b, 66c, 66d: Wires 68a, 68b, 68c, 68d: Ball screws 70a, 70b, 70c: Wire end guides 72a, 72b, 72c: Y Connection point 80: neck joint 82: head 84: clavicle portion 84a, 84b: long hole 86: flange 86a: shaft hole 88: shaft 90: shaft 92: flange 94: flange 96a, 96b, 96c, 96d: wire 98a, 98b, 98c, 98d: wire connection point 102: flange 104: movable plate 106: flange 108: guide rod 110: guide rod 112: guide rod 114: motor 116: gear 118: gear 120: feed screw 122: flat plate portion 124: Peak 126: Flange 128: Shaft 130: Flange 132: Shaft

Claims (5)

A thigh, a lower thigh, and foot section, and the knee joint of the lower leg portion is rotatably connected to the rotation axis extending in the lateral direction of the robot with respect to the thigh, to crus The ankle joint connecting the foot part around the rotation axis extending in the left-right direction of the robot, and the crus part attached to the thigh part and rotating the crus part via a wire to the thigh part an actuator comprises a first actuator for the second leg portion for rotating the foot through the wire with respect to the lower leg portion is attached to the thigh,
The lower leg actuator and lower leg part are connected by a lower leg wire that passes the rear side of the knee joint,
The first foot actuator and the front part of the foot located on the front side of the ankle joint are connected by a first wire passing through the knee joint front side;
The second foot actuator and the rear part of the foot located on the rear side of the ankle joint are connected by a second wire passing through the front side of the knee joint,
The lower leg wire is loosened by the lower leg actuator and the first and second wires are pulled together by the first and second foot actuators so that the lower leg moves forward of the robot relative to the thigh. A robot characterized by rotating toward . The ankle joint is connected to the lower leg so as to be rotatable about two axes of a rotation axis extending in the left-right direction of the robot and a rotation axis extending in the front-rear direction of the robot;
A third foot actuator attached to the thigh and rotating the foot relative to the lower leg;
The first foot actuator and the front outside of the foot located on the front side and outside of the ankle joint are connected by the first wire passing through the knee joint front side;
The third foot actuator and the front inner side of the foot located on the front side and the inner side of the ankle joint are connected by a third wire passing through the knee joint front side;
The lower leg wire is loosened by the lower leg actuator and the first, second and third wires are pulled together by the first, second and third foot actuators, so that the lower leg is attached to the thigh. The robot according to claim 1, wherein the robot rotates toward the front of the robot. The torso,
A hip joint connecting the trunk and the thigh;
Provided with at least one thigh actuator disposed on the torso and rotating the thigh with respect to the torso,
The thigh actuator and thigh are connected with a wire,
The robot according to claim 1 or 2 , wherein the thigh actuator is an actuator that drives the hip joint by adjusting the length of the wire. The hip joint is connected to the torso so that the thigh can rotate about a rotation axis extending in the left-right direction of the robot,
The first thigh actuator and the thigh are connected by a wire passing through the back side of the hip joint,
4. The robot according to claim 3, wherein the second thigh actuator and the thigh are connected by a wire passing through the front side of the hip joint. The hip joint is connected to the torso so that the thigh can rotate about two axes of a rotation axis extending in the left-right direction of the robot and a rotation axis extending in the front-rear direction,
The second thigh actuator and the thigh are connected by a wire that passes through the front and outside of the hip joint,
5. The robot according to claim 4 , wherein the third thigh actuator and the thigh are connected by a wire passing through the front side and the inside of the hip joint.

Images