Patent Application
20150090065
The present invention relates to a linear driving mechanism with self-weight compensation, an operation input device, and a surgery assistance system.
In the related art, master-slave type remote operation devices have been known as devices for performing remote operation. Generally, the master-slave type remote operation devices have an operation input device that allows an operator to perform an operation input and an actuation unit that is actuated by a command from the operation input device. In this case, it is known that a spring, an actuator, or a counter weight is used in order to compensate for the self-weight of the operation input device or the actuation unit to reduce the load during actuation.
For example, Japanese Unexamined Patent Application, First Publication No. H9-272082 discloses compensating self-weight using a constant tension spring. Additionally, Japanese Unexamined Patent Application, First Publication No. 2007-98507 discloses compensating self-weight using a motor. Moreover, Japanese Patent Publication No. 4144021 discloses compensating self-weight using a link and a spring.
A linear driving mechanism with self-weight compensation according to a first aspect of the present invention includes a holding member that holds a first moving body to which an object is attached, a second moving body provided with a weight, and a coupling portion that couples the first moving body to the second moving body so that the weight moves with a directional component in a direction opposite to a movement direction of the first moving body. The holding member is capable of rotating around a rotation axis. When a mass of the first moving body in a state where the object is attached is defined as M1, a mass of the second moving body is defined as M2, a distance between a first intersection point of a perpendicular line from a rotation center of the rotation axis to the first moving body and a first gravity center of the first moving body when the distance between the first intersection point and the first gravity center in the first moving body is the shortest is defined as L1, and a distance between a second intersection point of a perpendicular line from the rotation center of the rotation axis to the second moving body and a second gravity center of the second moving body when the distance between the second intersection point and the second gravity center in the second moving body is the shortest is defined as L2, M2=(L1/L2)×M1 is satisfied.
According to a second aspect based on the first aspect, the first moving body and the second moving body may linearly move in directions that are parallel to each other and opposite to each other.
According to a third aspect based on the first or second aspect, the first moving body may have a first rack extending in a direction of a straight line connecting the first intersection point and the first gravity center in the first moving body, the second moving body may have a second rack extending in a direction of a straight line connecting the second intersection point and the second gravity center in the second moving body, and the coupling portion may have a gear unit that engages with the first rack and the second rack.
According to a fourth aspect based on the third aspect, the gear unit may have a first gear that engages with the first rack; and a second gear that engages with the second rack, and when a first radius of the first gear is defined as d1 and a second radius of the second gear is defined as d2, M2=(L1/L2)×M1=(d1/d2)×M1 may be satisfied.
According to a fifth aspect of the present invention based on any one of the first to fourth aspects, the rotation center may be near the gravity center of the holding member.
An operation input device according to a sixth aspect of the present invention includes the linear driving mechanism with self-weight compensation according to any one of the first to fifth aspects; a base coupled to the linear driving mechanism with self-weight compensation; an abutment portion that is provided at the base and is capable of abutting against a portion of the first moving body; and a relative value type detector that detects a movement distance or a position of at least any one of the first moving body, the second moving body, and the coupling portion. The detector may be initialized in a positional relationship in which the first moving body has abutted against the abutment portion.
A surgery assistance system according to a seventh aspect of the present invention includes the operation input device according to the sixth aspect; and an actuation unit that has a surgical instrument for performing surgery on a patient, is connected to the operation input device, and is actuated at least on the basis of a movement distance or a position detected in the detector.
A linear driving mechanism with self-weight compensation (hereinafter simply referred to as a “linear driving mechanism”), an operation input device, and a surgery assistance system of a first embodiment of the present invention will be described.
As shown in
The master operation input device 2 functions as a master that transmits the movement of an operator Op to the slave manipulator 50, and includes a display unit 3 and an operation unit 4.
The display unit 3 displays an image of a patient P's surgery site and its vicinity taken by a camera (not shown). As the display unit 3, well-known display units, such as a liquid crystal display and an organic electroluminescent display, can be selected appropriately, and can be adopted.
As shown in
Op can perform an operation while viewing the display unit 3. Although not shown, in the present embodiment, operation units 4 are respectively provided on the right-hand side and left-hand side of the operator Op. As the operator Op grips a grip unit 40 of the operation unit 4, position and orientation information of the operation unit 4 is input to a position and orientation detector 53 to be described below. It is desirable that the operation unit 4 generally have six degrees of freedom. As long as only position information is input to the position and orientation detector 53, the operation unit 4 may have three degrees of freedom.
As shown in
The first joint 6 is a joint that makes the first arm 8 rotatable with respect to the base 5 around a rotational axis extending in a horizontal direction.
The second joint 9 is a joint that makes the holding member 21 rotatable with respect to the first arm 8 around a rotational axis orthogonal to the rotational axis of the first joint 6.
The third joint 11 is a linear motion joint that allows the first moving body 24 to advance and retreat with respect to the holding member 21 in a direction orthogonal to the rotational axes of the second joint 9 and the first joint 6.
The fourth joint 12 is a joint that makes the second arm 13 rotatable with a linear motion axis direction of the third joint 11 as a rotational axis.
The fifth joint 14 is a joint that makes the third arm 15 rotatable with respect to the second arm 13 around a rotational axis orthogonal to the rotational axis of the fourth joint 12.
The sixth joint 16 is a joint that makes the grip unit 40 rotatable with respect to the third arm 15 around a rotational axis orthogonal to the rotational axis of the fifth joint 14.
By using the first joint 6, the second joint 9, and the third joint 11, with a point where the rotational axes of the first joint 6 and the second joint 9 intersect each other as a center, a three-dimensional polar coordinate system can be established and the position of a tip portion of the first moving body 24 can be determined.
By arranging the grip unit 40 near a position where the rotational axes of the fourth joint 12, the fifth joint 14, and the sixth joint 16 intersect each other, a gimbal structure is obtained and a orientation can be input without changing a position with respect to the fourth joint 12.
That is, the grip unit 40 is arranged so that the rotational axes of the fourth joint 12, the fifth joint 14, and the sixth joint 16 intersect each other on an axis that passes through the intersection point of the rotational axes of the first joint 6 and the second joint 9 and is parallel to the linear motion axis of the third joint. Accordingly, the position of the grip unit 40 can be calculated from the movement distances of the first joint 6, the second joint 9, and the third joint 11.
The linear driving mechanism with self-weight compensation of the present embodiment has a configuration in which the operativity of the grip unit 40 is prevented from being impaired by compensating self-weight irrespective of the movement distances of the respective joints, even if the position of the grip unit 40 is moved.
As shown in
As shown in
The holding member 21 is a hollow member coupled to the first arm 8 via the second joint 9. A portion of the first moving body 24, a portion of the second moving body 26, and the coupling portion 29 are disposed inside the holding member 21. Additionally, a first guide 22 that holds the first moving body 24 so as to be able to advance and retreat, and a second guide 23 that holds the second moving body 26 so as to be able to advance and retreat are provided within the holding member 21. In the present embodiment, both the first guide 22 and the second guide 23 are fixed to an internal surface of the holding member 21. Additionally, the first guide 22 and the second guide 23 are disposed so as to be parallel to each other.
The holding member 21 is rotatable around the second joint 9 as a rotation axis. The position of the aforementioned rotation axis in the holding member 21 is near the gravity center of the holding member 21. The position of the rotation axis for rotating the holding member 21 may be shifted as long as the position is within a range where the frictional force of the holding member 21 is balanced with the frictional force of the first arm 8. For example, the position may be shifted about 1 cm or 2 cm from the gravity center of the holding member 21.
The first moving body 24 is formed in the shape of a rod, and is provided in a state where one end of the first moving body 24 protrudes from the holding member 21. The above-described fourth joint 12 is attached to a protruding end of the first moving body 24. In the present embodiment, the respective constituent elements (refer to
As shown in
The second moving body 26 is formed in the shape of a rod and disposed parallel to the first moving body 24. A weight 27 having a predetermined mass is fixed to the second moving body 26. The weight 27 is a balance weight for the object. The second moving body 26 has a rack 28 (second rack) extending in a length direction of the second moving body 26 (extending in the direction of a straight line connecting a second intersection point and a second gravity center (to be described below) in the second moving body 26).
The coupling portion 29 couples the first moving body 24 and the second moving body 26 so that the weight 27 moves with a directional component in a direction opposite to a movement direction of the first moving body 24. The coupling portion 29 of the present embodiment includes a pinion 30 (gear unit) that engages with the rack of the first moving body 24 and engages with the rack of the second moving body 26, and a shaft body 31 that rotatably supports the pinion 30. The pinion 30 is supported by the holding member 21 via the shaft body 31. That is, in the present embodiments, the first moving body 24, the second moving body 26, and the coupling portion 29 are configured so as to have parallel shaft gears. Since the first moving body 24 and the second moving body 26 are coupled via the pinion 30 in this way, the first moving body 24 and the second moving body 26 linearly move in directions that are parallel to each other and opposite to each other. In the present embodiment, an absolute value of the linear movement distance of the first moving body 24 and an absolute value of the linear movement distance of the second moving body 26 are equal to each other.
The position and mass of the weight 27 fixed to the second moving body 26 are set so that moments N1 and N2 of forces that are schematically shown in
M1gsinφr1=M2gsinφr1 (Expression 1)
M1gcosφ(L1+r1θ)=M2gcosφ(L2+r1θ) (Expression 2)
Here, φ is the rotation angle of the first moving body 24 from the horizontal axis, r1 is the radius of the pinion 30, and θ is the rotation angle of the pinion 30. The initial states of the first moving body 24 and the second moving body 26 are brought into a state where the linear motion of the third joint 11 is most shortened. From this, the distance L1 is the shortest distance between the position P1 and the position P2, and the distance L2 is the shortest distance between the position P3 and the position P4.
Additionally, the length L1 and the length L2 are the same unit system, and the mass M1 and the mass M2 are the same unit system.
Expression 1 and Expression 2 are solved, and
the mass of the weight 27 and the distance L2 are set so as to satisfy M2=M1 and L2=L1.
It is desirable that the gravity center position of a gross mass M3, not included in the mass M1 and the mass M2, of the holding member 21 and the first guide 22, the second guide 23, the coupling portion 29, an encoder 20a, and the like fixed without being moved with respect to the holding member 21 be at the position of the rotational axis (coincide with the shaft body 31 in the present embodiment) of the second joint 9, and the shape of the holding member 21 be adjusted to adjust the gravity center position.
Accordingly, since a moment around the pinion 30 is balanced with a moment around the axis of the second joint 9, the position of the object A is movable without being influenced by self-weight irrespective of the movement distance of the first moving body 24 and the rotational amount of the second joint 9.
In the present embodiment, a brake that applies slight resistance to advancing and retreating movement of the first moving body 24 may be provided at the linear driving mechanism 20 if necessary. As the brake, for example, a brake that generates sliding resistance between the holding member 21 (refer to
As shown in
Additionally, sensors for detecting the movement distances and positions of the respective joints and the third joint 11 are attached to the operation unit 4. For example, as shown in
As shown in
The slave manipulator 50 includes a surgical instrument 51 that operates according to the operation in the master operation input device 2. As the surgical instrument 51, for example, an endoscope, a treatment tool for an endoscope, medical equipment or a medical instrument for performing surgery with respect to the patient P, or the like can be appropriately selected and adopted if necessary.
As shown in
The master-side control unit 52a has a position and orientation detector 53 (detector) electrically connected to the respective encoders provided at the operation unit 4 of the master operation input device 2. In the present embodiment, the position and orientation detector 53 is an absolute value type detector, and detects the position and orientation of the operation unit 4 and an input state to the opening and closing switch portion 42 (refer to
In the slave-side control unit 52b, the results obtained by detecting the position and orientation of the operation unit 4 and the input state to the opening and closing switch portion 42 in the master-side control unit 52a are input to the slave-side control unit, a signal for actuating the slave manipulator 50 is generated, and the signal is output to the slave manipulator 50 to actuate each surgical instrument 51.
The entire control unit 52 may be disposed at the master operation input device 2, the entire control unit 52 may be disposed at the slave manipulator 50, or the control unit 52 may be installed as separate units at the master operation input device 2 and the slave manipulator 50.
Next, the operation of the third joint 11 of the present embodiment, the master operation input device 2, and the surgery assistance system 1 will be described.
In the present embodiment, as the first moving body 24 protrudes from the holding member 21 and linearly moves as shown in
As described above, according to the linear driving mechanism with self-weight compensation, the operation input device, and the surgery assistance system 1 of the present embodiment, the state where the moments of the forces are maintained with each other is maintained irrespective of the position of the second joint 9 and the linear motion position of the first moving body 24 in the third joint 11. Moreover, since balance can be achieved with one weight 27 with respect to both the rotation around the second joint 9 and the extension and retraction of the linear driving mechanism 20, the configuration can be made simple, and the operation input device can be made lightweight and small-sized while it is possible to precisely compensate for the self-weight.
Additionally, since the first moving body 24 and the second moving body 26 linearly move in the directions that are parallel to each other and opposite to each other, the first moving body 24 and the second moving body 26 do not interfere with each other during the movement of the first moving body 24 and the second moving body 26.
Additionally, since a so-called rack and pinion mechanism is constituted by the first moving body 24, the second moving body 26, and the coupling portion 29, the movement of the first moving body 24 is reliably transmitted to the second moving body 26, and the self-weight is precisely compensated for.
Next, a modified example of a linear driving mechanism (the third joint 11) with self-weight compensation of the present embodiment will be described.
In the present modified example, a gear unit 34 having a first gear 32 that engages with the rack 25 of the first moving body 24 and a second gear 33 that engages with the rack 28 of the second moving body 26 and has a smaller radius than that of the first gear 32 is provided as a gear unit that engages with the racks 25 and 28. The first gear 32 and the second gear 33 are coupled to each other so as to rotate around the same rotational axis.
In the present modified example, the movement distance of the second moving body 26 is smaller than the movement distance of the first moving body 24. As a result, the protruding amount of the second moving body 26 from the holding member 21 in the linear driving mechanism 20 is small, and the third joint 11 can be miniaturized.
In this case, the mass of the weight 27 attached to the second moving body 26 is set so that torques are balanced with each other as shown in the following Expressions 1 and 2.
M1gsinφd1=M2gsinφd2 (Expression 1)
M1gcosφ(L1+d1θ)=M2gcosφ(L2+d2θ) (Expression 2)
Here, φ is the rotation angle of the first moving body 24 from the horizontal axis, d1 is the radius (first radius) of the first gear 32, d2 is the radius (second radius) of the second gear 33, and θ is the rotation angle of the gear unit 34.
The mass of the weight 27 attached to the second moving body 26 only has to satisfy M2=(L1/L2)×M1=(d1/d2)×M1 from the above Expressions 1 and 2.
Accordingly, since a moment around the gear 34 is balanced with a moment around the axis of the second joint 9, the position of the grip unit 40 is not influenced by self-weight irrespective of the movement distance of the first moving body 24 and the rotational amount of the second joint 9, and the position of the grip unit 40 can be appropriately input.
For example, if M2 is made to be a mass twice as much as M1 when setting d1:d2=L1:L2=2:1, the protruding amount of the second moving body 26 from the holding member 21 can be suppressed to the half of the movement distance of the first moving body 24. As a result, the collision with the second moving body 26 and the base 5 can be avoided, and the operating range of the grip unit 40 of the operation input device can be increased while miniaturizing the device.
Next, an operation input device of a second embodiment of the present invention will be described. In addition, in the embodiment and its medication example to be described below, the same constituent elements as the constituent elements described in the above-described first embodiment will be designated by the same reference numerals, and duplicate description will not be repeated.
In the present embodiment, a relative value type movement distance detector 53A is provided instead of the absolute value type position and orientation detector 53 described in the first embodiment. That is, a movement distance based on a point of time when the movement distance detector 53A is initialized is detected by the movement distance detector 53A referring to the encoders 6a and 20a provided at the third joint 11.
Additionally, the base 5 is provided with an abutment portion 5a capable of abutting against a portion of the first moving body 24. Specifically, a protruding end 24a (an end opposite to the side where the fourth joint 12 is provided) of the first moving body 24 that protrudes from the linear driving mechanism 20 is enabled to abut against the abutment portion 5a of the base 5. The abutment portion 5a provided at the base 5 and the protruding end 24a of the first moving body 24 have such a concavo-convex shape that the abutment portion and the protruding portion are fittable to each other.
Since the first moving body 24, the second moving body 26, and the coupling portion 29 are coupled to each other, the movement distance detector 53A may not detect the movement distance of the first moving body 24 directly using the encoder 20a. For example, encoders that detect the movement distances of the second moving body 26 and the coupling portion 29 may be used.
If such a configuration is adopted, the relative positions of the base 5 and the linear driving mechanism 20, that is, the joint values of the first joint 6 and the second joint 9 and the position of the first moving body 24 in the third joint 11, are uniquely determined in a state where the protruding end 24a of the first moving body 24 is in contact with the abutment portion 5a.
If the movement distance detector 53A is initialized in a positional relationship in which the first moving body 24 has abutted against the abutment portion 5a, the orientation and extension and retraction amounts of the third joint 11 can be calculated by the movement distance detector 53A, using the positional relationship in which the first moving body 24 has abutted against the abutment portion 5a, as the starting point.
In the present modified example, the starting point can be easily determined with high repeatability by making the protruding end 24a of the first moving body 24 abut against the abutment portion 5a of the base 5 to initialize the movement distance detector.
Additionally, as the protruding end 24a of the first moving body 24 abuts against the abutment portion 5a, the operation input device can be fixed. Thus, the first moving body 24 can be prevented from moving unintentionally in the case of the transportation of the operation input device 4, or the like. As this protruding end 24a is located at the end of the first moving body 24 and the base 5 is arranged at the end of a movable range of the first moving body, the movable range of the operation input device 4 is not narrowed.
Next, a modified example of the present embodiment will be described.
In the present modified example, the abutment portion 5a (refer to
In the present modified example, the starting point can be determined each time the operation input device is used by making indispensable the step of making the protruding end 24a of the first moving body 24 abut against the abutment portion 5a of the base 5 at the beginning of use of the operation input device. Additionally, if the state where the protruding end 24a of the first moving body 24 abuts against the abutment portion 5a of the base 5 is determined as a housed state of the operation input device, the starting point can be determined whenever the operation input device is used, without making the operator Op conscious of the operation for detecting the starting point.
Although the embodiments of the present invention have been described above in detail with reference to the drawings, specific configuration is not limited to the embodiments, and design changes or the like are also included without departing from the scope of the present invention.
For example, in the above-described respective embodiments, the tooth form of the rack and the pinion may be any of a spur gear form, a helical gear form, and a double helical gear form. Additionally, instead of the rack and the pinion, the respective moving bodies may be coupled by a frictional force.
Additionally, the constituent elements shown in the above-described respective embodiments and respective modified examples can be appropriately combined.
In addition, design changes or the like to the above specific configurations are not limited to the above matters.
| Number | Date | Country | Kind |
|---|---|---|---|
| 2012-133547 | Jun 2012 | JP | national |
This application is a continuation application based on PCT/JP2013/066327, filed on Jun. 13, 2013, claiming priority based on Japanese Patent Application No. 2012-133547, filed in Japan on Jun. 13, 2012. The contents of both the Japanese Patent Application and the PCT Application are incorporated herein by reference.
| Number | Date | Country | |
|---|---|---|---|
| Parent | PCT/JP2013/066327 | Jun 2013 | US |
| Child | 14565863 | US |
