Patent Grant
7295893
This application is based upon and claims the benefit of priority from prior Japanese Patent Application No. 2003-096819, filed on Mar. 31, 2003, the entire contents of which are incorporated herein by reference.
1. Field of the Invention
The present invention relates generally to a manipulator, and its control device and method. More specifically, the invention relates to a medical manipulator operative in a master/slave mode, and its control device and method.
2. Related Background Art
In conventional laparoscope surgery such as laparoscopic cholecystectomy, an endoscope and forceps are inserted into an abdominal cavity through trocars set in small incisions made in the abdomen of a patient. Then, an operator conducts operation while watching the image acquired by the endoscope on a monitor. Since this type of operation does not need to open the abdomen, physical burden on the patient is alleviated, and the time required for recovery and discharge from the hospital after operation is greatly reduced. Therefore, its adaptation to wider fields of application is expected. Conventional laparoscope surgery, however, involves some problems. That is, the operator cannot directly observe the affected part of the patient. Additionally, there are used forceps only having an opening/closing gripper, not convenient to control and therefore unsuitable for surgery. Thus, the conventional laparoscope surgery needs high skills of operators.
To cope with these problems, it has been studied and is now being employed to furnish the forceps end with some degrees of freedom of motion so that a work unit (slave unit) at the forceps end having a plurality of degrees of freedom works in accordance with movements of a control unit (master unit) controlled by an operator to execute laparoscope surgery in a master/slave operative mode.
As one of master/slave medical manipulators, there is a remote-control device in which the master unit and the slave unit are normally located apart from each other. This is configured to set a plurality of slave arms on the patient and control positions and orientations of the medical manipulator's ends by controlling the master unit located apart from the patient. This system is complex and large-scaled, and needs high purchasing and maintenance costs. Moreover, it is not so convenient because of requiring much time to set the system ready for actual operation and being liable to interruption of operation. Furthermore, since the operator cannot attend closely to the patient during operation and is not available for quick treatment upon emergent accident, the system is insufficient from the viewpoint of safety.
There is another master/slave medical manipulator in which some of axes in the master unit and the slave unit are common axes. This is a simple, easy-to-employ, unitary medical master/slave manipulator. As compared with the foregoing remote-controlled manipulator, the operator can attend closely to the patient and directly controls the manipulator. Therefore, this unitary manipulator significantly reduces the problem of safety.
However, these medical manipulators have been developed mainly targeting their functions with affected parts to be operated or treated, and other issues remain unsolved, including how the system is easy to set in the operating room, easy for the operator to use, easy to sterilize and clean, easy to start its actual use, etc. as well as the issue of the cost.
One of problems of conventional techniques is that, if the master/slave medical manipulator is started to move from a status where the control unit (master unit) and the work unit (slave unit) do not coincide in orientation, the slave unit does not move as the user (operator) intends. This is because, if the operator starts to control the manipulator from those both do not coincide in orientation, the operator cannot accurately recognize the difference between the orientation of the slave unit displayed on the endoscopic monitor and the orientation of the control unit and gets confused. Under the condition, the manipulator is unreliable in controllability and degrades in safety. Thus, it involves technical problems to be overcome.
To overcome those problems, there is a method of bringing the master unit into agreement with the orientation of the slave unit held stationary (Japanese Patent Laid-open No. JP-H08-215204A). This method is a diversion of a method having been employed in an industrial robot. More specifically, in a manipulator having a detector means for detecting orientation angles of the slave portion and the master portion and a means for comparing results of their detection, while stopping the slave, the operator first controls and brings the master unit into agreement with the orientation of the slave, and thereafter starts the master/slave motion. However, this method fails to improve the controllability of the manipulator because the operator must conduct alignment of the orientations every time before starting or re-starting the master/slave motion. Moreover, since the operator must conduct the alignment for all of plural degrees of freedom of motion, it takes much time for the alignment. Furthermore, these problems cannot be disregarded also from the standpoint of quick attendance and treatment against unexpected accidents on site.
There is another method for automatically move the master unit into agreement with the orientation of the slave unit (Japanese Patent Laid-open No. JP-2002-053685). In this method, a manipulator includes a detector means for detecting orientation angles of the slave unit and the master unit and a means for sequentially comparing results of their detection. Then, the manipulator is operative in a transitional master/slave mode in which the slave is moved based on the difference between the orientation of the master unit and that of the slave unit as well as the time required for alignment of the orientations. This method removes the troublesome process of alignment, which is one of disadvantages of the foregoing method, and realizes the motion faithful to the operator's intention even during the alignment operation of orientations. However, if the alignment of orientations is started under existence of a large difference in orientation, then the distance of automatic movement of the slave unit and its time are large, and the slave unit starts moving in response to the alignment start command. Therefore, automatic motion out of the operator's intention appears saliently, and the safety issue still remains unsolved.
To overcome the problems involved in the conventional techniques discussed above, it is an object of the present invention to provide a medical manipulator enhanced in controllability and safety, which aligns the orientation of master unit and that of the slave unit without calling the operator's recognition about the process of the alignment when the operator starts controlling the master/slave medical manipulator, but does not effect automatic motions that are out of operator intention and therefore dangerous for medical use, and reflects the operator's intention to the motion of the slave unit even during the alignment operation.
According to an embodiment of the invention, there is provided a manipulator operative in a master/slave operative mode, comprising:
a master unit commanding an operation;
a slave unit having a work unit;
a detector detecting the orientation of the master unit and the orientation of the slave unit; and
a control device controlling the slave unit in response to the command from the master unit,
wherein the control device includes:
a function of determining a non-mater/slave operative mode or a master/slave operative mode;
a function of calculating a difference between the orientation of the master unit and the orientation of the slave unit; and
a function of comparing the absolute value of the difference with a preset reference value; and depending upon the result of the comparison, determining a normal master/slave operative mode or a transitional master/slave operative mode, in said master/slave operative mode, said transitional master/slave operative mode is a transitional mode from the non-master/slave operative mode to the master/slave operative mode.
According to a another embodiment of the invention, there is provided a control device of a manipulator working in a master/slave operative mode and having a master unit for commanding an operation, a slave unit having a work unit and operative in response to a command from the master unit, and a detector unit for detecting the orientation of the master unit and the orientation of the slave unit, comprising:
a function of calculating a difference between the orientation of the master unit and the orientation of the slave unit; and
a function of comparing the absolute value of the difference with a preset reference value, and switching the operative mode between a transitional master/slave operative mode and a normal master/slave operative mode depending upon the result of the comparison, the transitional master/slave operative mode being a transitional mode from a non-master/slave operative mode to the master/slave operative mode.
According to another embodiment of the invention, there is provided a method of control a manipulator working in a master/slave operative mode and having a master unit for commanding an operation, a slave unit having a work unit and operative in response to a command from the master unit, and a detector unit for detecting a difference between the orientation of the master unit and the orientation of the slave unit, comprising:
calculating a difference between the orientation of the master unit and the orientation of the slave unit; and
comparing the absolute value of the difference with a preset reference value, and depending upon the result of the comparison, determining a normal master/slave operative mode or a transitional master/slave operative mode which is a transitional mode from a non-master/slave operative mode to the master/slave operative mode.
According to another embodiment of the invention, there is provided a manipulator operative in a master/slave operative mode, comprising:
a master unit commanding an operation;
a slave unit having a work unit;
a detector detecting the position of the master unit and the position of the slave it; and
a control device controlling the slave unit in response to the command from the master unit,
wherein the control device includes:
a function of determining a non-mater/slave operative mode or a master/slave operative mode;
a function of calculating a difference between the position of the master unit and the orientation of the slave unit; and
a function of comparing the absolute value of the difference with a preset reference value;
and depending upon the result of the comparison, determining a normal master/slave operative mode or a transitional master/slave operative mode, in said master/slave operative mode, said transitional master/slave operative mode is a transitional mode from the non-master/slave operative mode to the master/slave operative mode.
First explained is an embodiment of the present invention, taking a medical manipulator as an example. As shown in
The medical manipulator body 1 includes, as shown in
The control device 2 includes, as shown in
A command input means 3 (
The operative condition presenter 5 presents the operative condition of the medical manipulator body 1 to allow the operator or assistant of the surgical operation to easily confirm how the manipulator is actually controlled and to thereby increase the safety of the operation. The operative condition presenter 5 is preferably located near the endoscope monitor so that the operator can catch the representation within his/her most natural field of view.
Behaviors of the arithmetic unit 14 shown in
If the medical manipulator body 1 comprises the master unit 8 and the slave unit 9 located apart from each other without the connector unit, this is a remote-controlled medical manipulator. In this case, the manipulator is operative in the master/slave mode by data communication between control devices associated with the master unit 8 and the slave unit 9 respectively.
Next explained are procedures for starting a master/slave operation with reference to
d=θm−θs (1)
The operator enters a command for activating the manipulator in the master/slave operative mode to the arithmetic unit through the command input means 3 or switches 17 of the control device 2. The arithmetic unit 14 acknowledges entry of the master/slave motion start command, and compares the difference d calculated by Equation (1) with a preset master/slave motion reference value A (S41). If the result of the comparison satisfies Equation (2), then the arithmetic unit 14 sets the manipulator in a transitional master/slave operative mode (S42).
|d|>A (2)
If the result of the comparison does not satisfy Equation (2), it means that the difference between the angular position of the master unit 8 and that of the slave unit 9 is very small. Then, the arithmetic unit 14 sets the manipulator in the normal master/slave operative mode (S43). Although it is ideal that the value of d is zero in the normal master/slave operative mode, since the angles and their reading intervals are discrete, it is quite rare to observe that the master unit 8 and the slave unit 9 completely agree in angular position (orientation). Therefore, if the zero difference is pursued, then the change too the normal master/slave operative mode will not be attained for a long time even though the master unit 8 and the slave unit 9 substantially agree in angular position. Since acceptable controllability of the manipulator is assured when the difference in orientation between the master unit 8 and the slave unit 9 is nearly zero, although not purely zero, the constant A is introduced for practical application.
The transitional master/slave operative mode (S44) is a process for the change from the non-master/slave operative mode, such as the stop mode, to the normal master/slave operative mode, and the operator can control the manipulator in this mode with the same feeling as he/she will have in the master/slave operative mode.
In this transitional master/slave operative mode, the arithmetic unit 14 defines the relation between the time difference Δθs of the target value of the slave unit 9 and the time difference Δθm of the orientation of the master unit 8 by Equation (3) using a parameter α.
Δθs=αΔθm (3)
Here is explained how to determine the parameter α in Equation (3) in the transitional master/slave operative mode (S44), depending upon the sign of the time difference Δθm of the orientation of the master unit 8 and the sign of the angular difference d between the master unit 8 and the slave unit 9. Whether the signs of these values are identical or opposite can be judged from the sign of D shown in Equation (4). If D is positive, both signs are equal. If the sign of D is negative, both signs are opposite.
D=Δθm×d (4)
When D>0, that is, when the sign of the time difference of the orientation of the master unit 8 is equal to the sign of the angular difference between the master unit 8 and the slave unit 9, it means that the operator controls the orientation of the master unit 8 in a direction away from the current orientation of the slave unit 9. In this case, by determining the parameter α to satisfy Equation (5), it is possible to generate an orientation target value of the slave unit 9 so that the orientation of the slave unit 9 catches up with the orientation of the master unit (generation of the accelerated follow target) (S45).
α>1 (5)
When D<0, that is, when the sign of the time difference of the orientation of the master unit 8 is different from the sign of the angular difference between the master unit 8 and the slave unit 9, it means that the operator controls the orientation of the master unit 8 in a direction toward the current orientation of the slave unit 9. In this case, by determining the parameter α to satisfy Equation (6), it is possible to generate an orientation target value of the slave unit 9 so that the orientation of the master unit catches up with the orientation of the slave unit 9 (generation of the decelerated follow target) (S46).
0≦α<1 (6)
The transitional master/slave operative mode (S44) is brought about in one of the above-mentioned cases. In any of these cases, once the operator stops the master unit 8, the slave unit 9 also stops (generation of the stop target) (S47) because the time difference Δθs of the target value of the slave unit becomes zero irrespectively of the value of the parameter α. That is, even in the transitional master/slave operative mode (S44), if the operator wants to stop the slave unit 9 in a desired orientation, he/she may only stop the control of the master unit 8 and can control the manipulator intuitively.
The arithmetic unit 14 monitors the magnitude of d expressed in Equation (1) in each control cycle or in predetermined intervals. When d=0, there is no angular difference between the master unit 8 and the slave unit 9, and these units agree in orientation. Thus, it changes the operative mode of the manipulator to the normal master/slave operative mode.
Heretofore, for easier understanding, explanation has been made assuming that the normal master slave operative mode is the operative mode equally setting the moving amount θmq of the master unit and the moving amount θsq of the slave unit following to the typical master/slave mode. Next, however, another extensive way of setting the parameter α will be explained, which will cope with various kinds of master/slave operative modes.
In the normal master/slave operation, the moving ratio may be changed between the master unit 8 and the slave unit 9 in order to enhance the controllability. For example, movement of the slave unit 9 may be a half of the movement of master unit. This is a technique used when a minute movement of the slave unit 9 is required and the master unit 8 is difficult to control for the same scale of minute movement. In contrast, movement of the slave unit 9 may be a double of the movement of the master unit 8 to reduce the operator's amount of movement and thereby alleviate the operator's load. As such, in the normal master/slave operative mode, the movement ratio may be changed as shown in Equation (7).
Δθs=βΔθm (7)
In case of a medical manipulator having this kind of normal master/slave operative mode, the transitional master/slave operative mode can be defined as Equation (8) converted from Equation (3).
Δθs=α*(βΔθm) (8)
Combining Equation (3) and Equation (8), relation between the slave target value and the master unit orientation in the transitional master/slave operative mode can be defined by Equation (9).
Δθs=αext Δθm (9)
Then, the parameter αext can be expressed by using the parameter β determined by the movement ratio in the normal master/slave operation or the operator's intention as follows.
0≦αext≦β (D<0) (10)
αext≧β (D>0) (11)
Medical manipulators having the typical master/slave operative mode, in general, are configured to reserve a slightly larger range of movement for the master unit 8 than that of the slave unit 9 to read the angle of the master unit 8 (S61), then generate the target value of the slave unit 9 after saturation processing of the angle (S63), again execute saturation processing and arithmetic operation (S64), and output a drive signal (S65) as shown in
Thus, the transitional master/slave operative mode in the embodiment of the invention satisfies Equation (9), Equation (10) and Equation (11). If it is desired to move the master unit 8 and the slave unit 9 in opposite directions, the sign of the parameter α may be inverted. The value of the parameter a should be selected within the range satisfying those equations.
Here is explained an application of determining the parameter α in Equation (3). In a medical manipulator having three degrees of freedom of motion including the freedom about the gripper axis in addition to the freedom about the yawing axis and the rolling axis, as shown in
Since this medical manipulator has a relatively large ovable range about the rolling axis than those about the other two axes, the parameter in the transitional master/slave operative mode was determined as Equation (13) and Equation (14).
When Δθm and d have the same sign,
When Δθm and d have the opposite signs,
By changing the value of the parameter α for each axis to be controlled and changing the motion speed about each axis in the transitional master/slave operative mode, the manipulator can be adjusted in controllability. As to adjustment of the parameter, the manipulator may be configured to permit the operator to change the setting of the parameter as desired through interface prepared in the medical manipulator system, such as a terminal externally connected to the control deice, for example. In this case, the arithmetic unit will read the new setting value and control the work unit accordingly. Thus, the medical manipulator permitting adjustment in the operator's favor can be realized.
In case much importance is given to the response to controls also in the transitional master/slave operative mode to realize alignment of orientations in the transitional master/slave operative mode without reducing the speed lower than that of the normal master/slave operative mode, the value of αext under D<0 is set to β to enable alignment of orientations without using the decelerated follow. In this manner, while the master unit moves closer to the slave unit (D<0), the speed does not decrease although the difference in orientation is not removed. While the master unit moves away from the slave unit (D>0), the difference in orientation is removed.
In contrast, in case much importance is given to safety and an increase of the speed should be prevented, the value of αext under D>0 is set to β because the accelerated follow is desired to cancel in the transitional master/slave operative mode. In this case, the difference in orientation is not removed, but an increase of the speed does not occur. Instead, αext is determined to remove the difference in orientation when D<0.
If the value of αext under D<0 is always β regardless of the sign of D, this is the case where the slave unit moves relative to the movement of the master unit while the difference d remains unchanged. This mode of operation is usable when the configuration of the master unit is different from the configuration of the slave unit, e.g., when it is controlled through a relative input device such as switches or levers.
In other words, the manipulator is configured to include the function to employ or discard the operating manner in the transitional master/slave operative mode.
Here is explained an application of an embodiment of the invention for resuming the master/slave operation. There is a method of restricting movements about any particular one of the axes of the slave unit in the master/slave operative mode in order to enhance the controllability. The condition restricting a movement about the particular axis corresponds to the condition where the particular axis of the master/slave operative axes is set in a non-master/slave operative mode. The embodiment of the invention is applicable also upon returning to the normal master/slave operative mode. Regarding the release of the restriction as the start command of the master/slave operative mode, transitional master/slave operation may be conducted regarding the axis heretofore restricted.
During controls of a medical manipulator in the master/slave operative mode, the actual orientation of the slave unit may deviate from the target value produced for the slave unit due to a suture thread entangling on a joint of the manipulator or an excessive load to the manipulator end, for example. Upon these occasions, the medical manipulator has to demonstrate an alarm signal to the operator's awareness by representation on an operative condition presenter, for example, and simultaneously remove the irregular condition to recover the safety of the surgical operation immediately. In this case, the arithmetic unit may be configured to recognize the alarm signal and previously store the recovery procedure to remove the difference in orientation produced between the slave unit and the master unit. Then, it is possible to restore the normal master/slave operation quickly by using the transitional master/slave operation according to the invention to resume the surgical operation quickly and safely.
Upon changing a non-master/salve operative mode to the master/slave mode, automatic alignment of orientations is better for controllability provided it is surely safe. For example, before the slave is inserted into the patient's body, there may be nothing to hit in its movable range. The medical manipulator may be provided with input switches allowing the operator to distinctively command the alignment of orientations by automatic operation (for example, Japanese Patent Laid-open JP-2001-243434A (here is called automatic transitional operation) and the alignment according to the invention, respectively, so that the arithmetic unit reads the input in its process of monitoring operation commands and may execute the switching in its operation judging process. In this manner, it is possible to realize a medical manipulator having the function of switching the automatic transitional operation and the transitional master/slave operation for alignment of orientations, and therefore enhanced in controllability. If the arithmetic unit is configured to conduct the operation command monitoring process and the operation judging process for each axis, these methods of alignment of orientations can be executed for each axis.
The master unit may include power torque sensors associated with the axes to transmit the force or torque as information from the master unit to the arithmetic unit. If the arithmetic unit has the function of converting the information on the force or torque to information on position or speed, the transitional master/slave operative mode is applicable.
As described above, according to the invention, it is possible to provide a medical manipulator enhanced in controllability and safety.
Additional advantages and modifications will readily occur to those skilled in the art. Therefore, the invention in its broader aspects is not limited to the specific details and representative embodiments shown and described herein. Accordingly, various modifications may be made without departing from the spirit or scope of the general inventive concepts as defined by the appended claims and their equivalents.
Hereinafter, examples will be described, which show that the present invention can be applied to a different structure type master/slave manipulator in which the degrees of freedom of motion differ between a control unit (master unit) 8 and a work unit (slave unit) 9.
The control unit 900 includes a bracket 901 connected to the base side of the connector unit 10, a control rod 902 having a cylindrical shape connected to the bracket 901 so as to be able to rotate around a control rod axis, and control devices attached to the control rod 902, which have a function to determine the position/orientation of a work unit (slave unit) 9.
As shown in
A sensor for detecting the amount of movement is installed to each of the horizontal direction dial 903, the vertical direction dial 904, and the trigger 905. A sensor signal is sent to the control device 2, and processed by the arithmetic unit 14.
The structure of the control unit will be described in detail below with reference to
The sensor 911 for detecting the rotational position (a absolute position or a relative position) of the horizontal direction dial 903 is attached to the control rod 902. The rotating portion of the sensor 911 is connected with the horizontal direction dial 903. In this manner, it is possible to detect the rotational position of the horizontal direction dial 903 relative to the control rod 902.
The sensor 912 for detecting the rotational position (a absolute position or a relative position) of the vertical direction dial 904 is attached to the control rod 902. An axis of a pulley 913 engaging with the vertical direction dial 904 is connected with the sensor 912. In this manner, it is possible to detect the rotational position of the vertical direction dial 904 relative to the control rod 902. The reason why the pulley 913 is provided is the structural limitation for locating the sensor 912 within the control rod 902.
The gripper opening and closing movements of the work unit are caused by pressing and releasing the trigger 905. The trigger 905 can be pressed against the control rod 902 and released. Namely, trigger 905 may be pressed into the control rod 902 against restoring force of a spring (unshown on the
The value detected by the sensor 914 is converted to obtain the gripper opening/closing target value. The state in which the trigger 905 is depressed to a certain position corresponds to the sate the gripper is most closed, i.e., the state in which the opening/closing angle in
The operative mode change-over switch 906 is for switching the operative mode of the master/slave motion, including “start” “stop”, “initial position recovery”, etc.
As described above, it is possible to convert the rotational position and the depressed position of the devices of the control unit to the target value θ m of the work unit even in a master/slave manipulator in which the control unit and the work unit have different structures, thereby defining the positional relationship between the control unit and the work unit. Accordingly, when the master/slave operation start command is inputted with the change-over switch etc., it is possible to safely solve the problem of the difference between the master unit and the slave unit by employing the control method according to the present invention.
The above-described example of the control unit having a different structure includes two rotating dials and a trigger. However, a control unit including, instead of the two dials, a spherical shaped device having a sensor for detecting the rotational angles of two axial directions of the device, or a control unit including a device which can be displaced in a plane by receiving a force in a planar direction, the device having a sensor for detecting the amount of displacement, can also be used. In such cases, it is apparent that the control method according to the present invention can be applied since the difference in position/orientation between the control unit and the work unit can be defined by converting the amounts detected by the sensors to the target values of the work unit. Specifically, if the angle of the control unit corresponding to that of the work unit can be correctly defined, it is possible to perform the master/slave operation by applying the present invention regardless of the structure of the control unit and the type of the devices. In other words, it is possible to safely solve the difference in position/orientation between the master unit and the slave unit by employing the control method according to the present invention in both the case where the orientation of the work unit is determined by the orientation of the devices included in the control unit and the case where the orientation of the work unit is determined by the position of the devices included in the control unit. In addition, the control method according to the present invention can also be applied to the case where the position of the work unit is determined by the position and the orientation of the devices included in the control unit.
Furthermore, since the control method according to the present invention can be applied to only a part of the operational axes of the work unit, it is only necessary for the control unit to determine the orientation/position using the amounts detected by the sensor for generating the target values of the corresponding axes. That is to say, it is not necessary to determine the orientation/position for all the operational axes. For example, a detected amount of rotation of a rotational dial can be used as a speed target value of the work unit and a detected position of a trigger can used as an orientation target value of the work unit.
In Example 7, the target value is generated so that as the trigger is depressed more, the gripper angle is decreased. However, the target value can be generated so that as the trigger is depressed more, the gripper angle is increased. For example, with respect to dissecting forceps for separating tissues and instruments for moving organs that are not the targets of the surgery in order to ensure the working area and the field of view, the gripper of the work unit is mainly moved is the opening direction. Compared with the movement to pull out the trigger, the movement to depress the trigger gives a lighter load to the finger performing the operation. Accordingly, in the aforementioned instruments, the load of the operator can be decreased if the gripper is opened as the trigger is depressed.
It would be convenient if it is possible to use only one control device to operate a plurality of medical manipulators. However, if it is necessary to change the direction of the movement of the trigger in accordance with the types of instruments and the contents of the works, the relationship between the control unit and the work unit as mentioned before cannot be applied. In such a case, it is possible to safely change the directions of the opening/closing of the gripper in accordance with the instruments used and the intentions of the operator by providing a device for providing a command with respect to the direction in which the gripper is moved when the trigger is moved in a certain direction, and also by providing a function to temporarily change the operative mode to the non-master/slave mode and then change the operative mode again to the transitional master/slave mode or the normal master/slave mode in response to the command received from the device
Specifically, the operation can be performed in the following manner. At the time when the master/slave motion is carried out in accordance with a control method in which the gripper is closed as the trigger is depressed (hereinafter referred to as “grasping operative mode”), when a change-over command is inputted from a trigger motion change-over device, the operative mode is temporarily changed to the non-master/slave mode, and the movement of the work unit is stopped for one cycle of the control period (for example, 1 ms). At this time, the gripper is stopped at a gripper angle of θc, which is the angle of the time the change-over command is inputted, in the grasping operative mode. This corresponds to the point C shown in
As described above, even in the case where the relationship between the control direction and the movement direction of an operational axis should be changed, the operability and the safety of the manipulator can be secured by applying an embodiment of the present invention thereto in such a manner to provide a device for commanding a change-over operation, a function for temporarily stopping the master/slave operation in response to the command, a function to switch the relationship between the work unit and the control unit, a function to calculate a new target value based on the aforementioned relationship, thereby calculating a difference in position/orientation between the work unit and the control unit, and a function to change the operative mode to the transitional master/slave mode.
| Number | Date | Country | Kind |
|---|---|---|---|
| 2003-096819 | Mar 2003 | JP | national |
| Number | Name | Date | Kind |
|---|---|---|---|
| 5047701 | Takarada et al. | Sep 1991 | A |
| 5859934 | Green | Jan 1999 | A |
| 6120433 | Mizuno et al. | Sep 2000 | A |
| 6330493 | Takahashi et al. | Dec 2001 | B1 |
| 6411856 | Takeuchi et al. | Jun 2002 | B1 |
| 6424885 | Niemeyer et al. | Jul 2002 | B1 |
| 6432112 | Brock et al. | Aug 2002 | B2 |
| 6434448 | Kosaka et al. | Aug 2002 | B1 |
| 6459926 | Nowlin et al. | Oct 2002 | B1 |
| 6493608 | Niemeyer | Dec 2002 | B1 |
| 6522906 | Salisbury et al. | Feb 2003 | B1 |
| 6659939 | Moll et al. | Dec 2003 | B2 |
| 6853879 | Sunaoshi | Feb 2005 | B2 |
| 6889116 | Jinno | May 2005 | B2 |
| Number | Date | Country |
|---|---|---|
| 4-360777 | Dec 1992 | JP |
| 8-99278 | Apr 1996 | JP |
| 8-215204 | Aug 1996 | JP |
| 2003-53685 | Feb 2003 | JP |
| 2003340752 | Dec 2003 | JP |
| 2004299012 | Oct 2004 | JP |
| Number | Date | Country | |
|---|---|---|---|
| 20060095143 A1 | May 2006 | US |
| Number | Date | Country | |
|---|---|---|---|
| Parent | 10813110 | Mar 2004 | US |
| Child | 11259148 | US |
