WO2023002642A1 - 駆動装置及びその制御方法、並びにパラレルリンクロボット及びその制御方法 - Google Patents

駆動装置及びその制御方法、並びにパラレルリンクロボット及びその制御方法 Download PDF

Info

Publication number
WO2023002642A1
WO2023002642A1 PCT/JP2021/044324 JP2021044324W WO2023002642A1 WO 2023002642 A1 WO2023002642 A1 WO 2023002642A1 JP 2021044324 W JP2021044324 W JP 2021044324W WO 2023002642 A1 WO2023002642 A1 WO 2023002642A1
Authority
WO
WIPO (PCT)
Prior art keywords
correction
correction amount
driving device
actuator
current position
Prior art date
Application number
PCT/JP2021/044324
Other languages
English (en)
French (fr)
Inventor
諭 稲垣
澄雄 杉田
Original Assignee
日本精工株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 日本精工株式会社 filed Critical 日本精工株式会社
Priority to JP2022516459A priority Critical patent/JP7088440B1/ja
Priority to EP21950991.6A priority patent/EP4375029A1/en
Priority to US17/921,173 priority patent/US11766778B2/en
Publication of WO2023002642A1 publication Critical patent/WO2023002642A1/ja

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00—Manipulators not otherwise provided for
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00—Control of position or direction

Definitions

  • the present invention relates to a driving device and its control method, and a parallel link robot and its control method.
  • a robot that uses a parallel link has the advantage of being superior to a general serial link robot in terms of positioning accuracy and rigidity.
  • the positioning error of each axis that constitutes the robot greatly affects the accuracy of the tip position of the robot arm, techniques for reducing such positioning error are being studied.
  • Patent Document 1 a technique for correcting a positioning error of a movable part caused by friction or backlash when moving the movable part using a ball screw device that converts the rotation of a motor into linear motion
  • Patent document 1 corrects the position error that occurs when the moving part of the machine tool reverses the direction of movement, but does not consider the lead error of the ball screw and the effects of cogging peculiar to the pulse motor. . If such an error were to be corrected by feedback control, the gain would have to be increased, which could make the system unstable. Further, the configuration of Patent Document 1 employs a drive mechanism using a servomotor and a rotary encoder instead of a parallel link mechanism. Servomotors have poor stability at rest, making it difficult to maintain accurate positioning of moving parts. Also, the use of a linear encoder in addition to the rotary encoder results in a complicated system configuration. Although Patent Document 2 is a technology of a parallel link mechanism, each link is simply feedback-controlled. Therefore, it is difficult to precisely position the tip of the end effector due to the lead error and cogging error described above.
  • the present invention provides a driving device and a control method thereof, a parallel link robot, and a method of controlling the tip position of an end effector precisely and stably by reducing the correction amount of feedback control without complicating the structure.
  • the object is to provide a control method.
  • a correction unit that corrects an input command signal to generate a correction signal, an actuator that advances and retreats a movable unit according to the correction signal, and a position sensor that detects the current position of the movable unit.
  • the actuator has a nut connected to the movable portion, a ball screw shaft to which the nut is screwed, and a pulse motor for rotationally driving the ball screw shaft;
  • the correction unit has a correction amount map in which a position correction amount for calibrating a predictable error due to the structure of the actuator is mapped for each position of the movable unit, and ideally moves the movable unit according to the command signal.
  • a driving device that generates the correction signal by correcting the command signal so that the difference from the ideal movement position is reduced.
  • a correction unit that corrects an input command signal to generate a correction signal, an actuator that advances and retreats a movable portion according to the correction signal, and a position sensor that detects the current position of the movable portion; wherein the actuator has a nut connected to the movable part, a ball screw shaft to which the nut is screwed, and a pulse motor that rotationally drives the ball screw shaft.
  • the correction unit has a correction amount map in which a position correction amount for calibrating a predictable error due to the structure of the actuator is mapped for each position of the movable unit, and the command signal causes the movable unit to a step of estimating an ideal movement position to be moved; a step of obtaining the position correction amount corresponding to the current position detected by the position sensor by referring to the correction amount map; and correcting the current position with the position correction amount. and generating the correction signal obtained by correcting the command signal so that the difference between the corrected current position and the ideal movement position is reduced.
  • a correction unit that corrects an input command signal to generate a correction signal, an actuator that advances and retreats a movable portion according to the correction signal, and a position sensor that detects the current position of the movable portion;
  • a parallel link robot configured by using a plurality of drive devices and changing the position and orientation of a robot tip axis, wherein the actuator includes a nut connected to the movable part and a ball screw to which the nut is screwed. and a pulse motor that rotationally drives the ball screw shaft.
  • Each correction unit estimates an ideal movement position to which the movable unit moves according to the command signal, refers to the correction amount map, and controls the position sensor finds the position correction amount corresponding to the detected current position, and corrects the command signal so that the difference between the corrected current position obtained by correcting the current position with the position correction amount and the ideal movement position becomes small.
  • a parallel link robot that generates the correction signal.
  • a correction unit that corrects an input command signal to generate a correction signal, an actuator that advances and retreats a movable portion according to the correction signal, and a position sensor that detects the current position of the movable portion;
  • a control method for a parallel link robot configured by using a plurality of driving devices provided with the actuator to change the position and orientation of a robot tip axis, wherein the actuator includes a nut connected to the movable part and a nut screwed together. and a pulse motor for rotationally driving the ball screw shaft, and the correction unit adjusts the position correction amount for calibrating a predictable error caused by the structure of the corresponding actuator.
  • the position of the tip of the end effector can be precisely and stably controlled by reducing the correction amount of feedback control without complicating the structure.
  • FIG. 1 is a front perspective view of a parallel link robot.
  • FIG. 2 is a rear perspective view of the parallel link robot.
  • FIG. 3 is a top view of the parallel link robot.
  • FIG. 4 is an explanatory diagram schematically showing the configuration and operation of the parallel link robot.
  • FIG. 5A is a diagram showing movement of the needle 25 when the first link portion 13 is driven.
  • FIG. 5B is a diagram showing how the needle 25 moves when the first link portion 13 is driven in the direction opposite to that in FIG. 5A.
  • FIG. 6 is an explanatory diagram schematically showing an example of end effector control during ophthalmic surgery.
  • FIG. 7 is an explanatory diagram showing the influence of an actuator error, taking the first link portion as an example.
  • FIG. 8 is a schematic configuration diagram of the driving device.
  • FIG. 8 is a schematic configuration diagram of the driving device.
  • FIG. 9 is a graph showing the error between the commanded position instructed to the actuator and the actual movement position for each commanded position.
  • FIG. 10 is a control block diagram showing details of processing by the first control method.
  • FIG. 11 is a control block diagram showing details of processing by the second control method.
  • FIG. 12 is a control block diagram of the second integrated converter.
  • FIG. 1 is a front perspective view of a parallel link robot.
  • FIG. 2 is a rear perspective view of the parallel link robot.
  • the parallel link robot 100 includes a first link portion 13 having a first drive device 11A and a second drive device 11B, and a second drive device 15A and a second drive device 15B having a third drive device 15A and a fourth drive device 15B. It includes a link portion 17 , a fifth driving device 19 , an end effector 21 for ophthalmic surgery provided on the fifth driving device 19 , and an integrated control portion 23 .
  • the end effector 21 is provided with a needle (for example, a surgical instrument such as a cannula) 25 at its tip and is driven forward and backward by the fifth driving device 19 .
  • a needle for example, a surgical instrument such as a cannula
  • the first driving device 11A of the first link portion 13 advances and retreats the support plate 31A, which is the movable portion, toward the second link portion 17.
  • the second drive device 11B advances and retreats the support plate 31B, which is a movable portion, toward the second link portion 17.
  • Support portions 33A and 33B are fixed to the support plates 31A and 31B, respectively.
  • a first connection member 35 is arranged facing the support plates 31A and 31B. Brackets 37A and 37B are fixed to the surface of the first connecting member 35 on the first link portion 13 side.
  • the bracket 37A is rotatably connected to the support portion 33A of the support plate 31A, and the bracket 37B is rotatably connected to the support portion 33B of the support plate 31B.
  • the third drive device 15A and the fourth drive device 15B of the second link portion 17 are fixed to the surface of the first connection member 35 opposite to the first link portion 13 side. As shown in FIG. 1, the third driving device 15A of the second link portion 17 advances and retreats the support plate 41A, which is the movable portion. Similarly, the fourth driving device 15B advances and retreats the support plate 41B, which is a movable portion. Support portions 43A and 43B are fixed to the support plates 41A and 41B, respectively.
  • a second connection member 45 is arranged facing the support plates 41A and 41B.
  • the second connection member 45 is a member having an L-shaped cross section, and brackets 47A and 47B are fixed to the surface of the second connection member 45 on the second link portion 17 side.
  • the bracket 47A is rotatably connected to the support portion 43A of the support plate 41A, and the bracket 47B is rotatably connected to the support portion 43B of the support plate 41B.
  • the brackets 47A and 47B are fixed to one side of the L-shaped cross section of the second connecting member 45, and the fifth driving device 19 is fixed to the other side.
  • FIG. 3 is a top view of the parallel link robot 100.
  • the forward and backward direction of the movable portion of the first link portion 13 is the X direction
  • the forward and backward direction of the movable portion of the second link portion 17 is the Y direction
  • the direction perpendicular to the X and Y directions is the Z direction.
  • the forward/backward direction of the first link portion 13 is assumed to be the horizontal direction
  • the Z direction is assumed to be the vertical direction.
  • the first driving device 11A includes an actuator 53 that drives the rod 51 forward and backward, and a slider 55 that supports the actuator 53 so as to be slidable in one axial direction. A part of the slider 55 is fixed with the above-described support plate 31A. Although not shown, the second driving device 11B has the same configuration.
  • the parallel link robot 100 is operated based on the actuators 53 of the first drive device 11A and the second drive device 11B.
  • the actuator 53 is fixed to a fixed portion (not shown), and the slider 55 and the rod 51 slide in the X direction with respect to the actuator 53, forming a movable portion together with the support plate 31A.
  • the third drive device 15A and the fourth drive device 15B have the same configuration, except that the actuator 53 is fixed to the first connection member 35 .
  • FIG. 4 is an explanatory diagram schematically showing the configuration and operation of the parallel link robot 100.
  • the first connecting member 35 is tilted about the axis L1 (arrow R1 direction) by the driving in the S1 direction by the first driving device 11A or the driving in the S2 direction by the second driving device 11B.
  • the second connection member 45 is tilted about the axis L2 (arrow R2 direction) by driving in the S3 direction by the third driving device 15A or by driving in the S4 direction by the fourth driving device 15B.
  • the needle 25 at the tip of the end effector 21 attached to the second connecting member 45 via the fifth driving device 19 can be moved in the R1 and R2 directions.
  • the needle 25 can be moved in any three-dimensional direction.
  • the end effector 21 is driven by the set of the first drive device 11A and the second drive device 11B and the set of the third drive device 15A and the fourth drive device 15B. It is possible to move the tip.
  • the fifth driving device 19 enables the forward and backward movement of the distal end of the end effector 21 along the axial direction. With such a simple configuration, the end effector can be stably controlled.
  • the independent operation of each driving device enables highly accurate independent position control, and fine control of the tip of the end effector 21 becomes possible.
  • FIG. 5A is a diagram showing how the needle 25 moves when the first link portion 13 is driven.
  • FIG. 5B is a diagram showing how the needle 25 moves when the first link portion 13 is driven in the direction opposite to that in FIG. 5A.
  • the first driving device 11A of the first link portion 13 is driven in the direction of the arrow X1
  • the first connection member 35 tilts, and the second link portion 17 fixed to the first connection member 35
  • the fifth drive 19 and the end effector 12 tilt together.
  • the second driving device 11B of the first link portion 13 is driven in the direction of the arrow X2
  • the first connecting member 35 tilts in the direction opposite to that shown in FIG.
  • the part 17, the fifth drive 19 and the end effector 21 tilt together.
  • the tip position of the needle 25 can be swung at angles ⁇ 1 and ⁇ 2 from the vertical direction.
  • the swing center can be adjusted appropriately by feeding out the needle 25 of the fifth driving device 19 .
  • the parallel link robot 100 with this configuration, it is possible to operate with 5 to 6 degrees of freedom and high accuracy on the order of ⁇ m. Therefore, it can be applied to a robot for ophthalmic surgery, which requires so-called RCM (Remote Center of Motion) control to operate around a specific point located far from the actuator.
  • RCM Remote Center of Motion
  • FIG. 6 is an explanatory diagram schematically showing an example of end effector control during ophthalmic surgery.
  • the needle 25 is controlled with the entrance 61 to the eyeball as the center of rotation.
  • high positioning accuracy of each axis by the actuator is required.
  • FIG. 7 is an explanatory diagram showing the influence of actuator error, using the first link portion 13 as an example.
  • the tilting angles ⁇ 1 and ⁇ 2 of the first connecting member 35 are determined by the driving operations of the first driving device 11A and the second driving device 11B, and the position of the needle 25 is determined according to the tilting angles. Attitude is determined.
  • an error of ⁇ L1 occurs in the actuator 53 of the first driving device 11A and an error of ⁇ L2 occurs in the actuator 53 of the second driving device 11B, even if the magnitudes of the errors ⁇ L1 and ⁇ L2 are minute, the The tilting angle of the one connecting member 35 changes greatly. Due to this angle variation, the error at the position O becomes ⁇ L3, and the error increases as the position is farther from the actuator 53 .
  • the actuators 53 of the first link portion 13, the second link portion 17, and the fifth drive device 19 are independently controlled to prevent occurrence of positional errors.
  • the first driving device 11A, the second driving device 11B, the third driving device 15A, the fourth driving device 15B, and the fifth driving device 19 have the same configuration, and are collectively referred to as the driving device 10 in the following description. explain.
  • FIG. 8 is a schematic configuration diagram of the driving device 10.
  • the drive device 10 includes a controller 65 that corrects an input command signal Sd to generate a correction signal Sc, an actuator 53 that advances and retreats a rod 51 that is a movable portion according to the correction signal Sc, and a rod that is a movable portion. and a position sensor 67 for detecting the current position of 51 .
  • a position sensor 67 a linear encoder having a scale 67a and a reading portion 67b is used as the position sensor 67. By using a linear encoder, the movement of the movable part can be directly detected along the direction of movement, and highly accurate detection is possible.
  • the controller 65 and the position sensor 67 may be arranged inside the housing 53a of the actuator 53, or may be arranged on the side of the housing 53a.
  • the actuator 53 has a nut 69 connected to the rod 51, a ball screw shaft 71 to which the nut 69 is screwed, and a pulse motor 73 that drives the ball screw shaft 71 to rotate.
  • the ball screw shaft 71 is rotatably supported and the nut 69 is moved.
  • the nut may be rotatably fixed to the pulse motor and the ball screw shaft moved. In that case, the actuator can be made more compact.
  • the pulse motor 73 is preferably a stepping motor.
  • a stepping motor is more stable at rest than a servomotor, and does not require a rotary encoder for detecting the rotation of the servomotor, thereby simplifying the configuration.
  • piezo actuators it can be driven at a low voltage suitable for medical equipment.
  • the stationary state can be maintained by the frictional force between the ball screw shaft 71 and the nut 69 even when the power supply is turned off, and the posture of the robot can be stably maintained.
  • FIG. 9 is a graph showing the error between the commanded position instructed to the actuator and the actual movement position for each commanded position. 9. The error representing the variation between the command position and the actual movement position shown in FIG. This is due to the fact that vibration of several ⁇ m is generated several tens to several hundred times at each time. In the case shown in FIG. 9, the error ⁇ S is approximately 20 ⁇ m.
  • the error between the lead error of the ball screw device and the cogging of the pulse motor is an error that can be measured in advance.
  • This error can be corrected by constructing a correction amount map based on the On the other hand, errors due to thermal expansion, wear, etc. of the ball screw device cannot be measured in advance.
  • the command to the actuator is divided into pre-measurable errors and pre-measurable errors and corrected. That is, regarding the information of the target position indicated by the command signal, the error that can be measured in advance is referred to the correction amount map mapped, and the position correction value corresponding to the position information obtained from the position sensor 67 is obtained and fed forward. Correction is performed by control, and errors that cannot be measured in advance are corrected by feedback control.
  • a pulse motor 73 included in the actuator 53 shown in FIG. 8 is driven by a correction signal Sc including a speed correction value Vc obtained by correcting the speed setting value Vdes of the command signal Sd input to the driving device 10 in a predetermined procedure.
  • FIG. 10 is a control block diagram showing the details of processing by the first control method.
  • the speed set value Vdes is corrected by feedforward control based on a speed correction value VFF from a first correction unit 81, details of which will be described later, and feedback control based on a speed correction value VFB from a second correction unit 83, details of which will be described later.
  • a signal of the corrected speed correction value Vc is input to the controller 65 .
  • the controller 65 drives the pulse motor 73 shown in FIG. 8 according to the input speed correction value Vc signal. As a result, the rod 51, which is a movable portion, moves via the ball screw shaft 71 and the nut 69. As shown in FIG. The controller 65 outputs the current position Xenc of the movable portion detected by the position sensor 67 of the movement of the rod 51 .
  • the current position Xenc output from the controller 65 is input to the map section 85 .
  • the map unit 85 has a correction amount map in which lead errors and errors due to cogging, which are errors that can be measured in advance, are mapped for each position of the movable part.
  • the map unit 85 refers to the correction amount map and outputs the position correction amount Xerr corresponding to the current position Xenc.
  • the position correction amount Xerr is input to the first correction unit 81 .
  • the first correction unit 81 performs correction processing for the position correction amount Xerr, which is an error amount that is known to occur in advance, on the speed setting value Vdes. That is, the first correction unit 81 calculates the speed correction value VFF for adjusting the speed setting value Vdes so that the error represented by the position correction amount Xerr is zero. In other words, the first correction unit 81 adjusts the speed setting value Vdes according to the position correction amount Xerr by feedforward control.
  • the speed set value Vdes input to the controller 65 is also input to the conversion unit 87 .
  • the conversion unit 87 estimates the ideal movement position Xdes of the movable unit when the actuator is driven based on the input speed setting value Vdes.
  • a corrected current position Xreal is obtained by correcting the current position Xenc of the movable part output from the controller 65 with the position correction amount Xerr corresponding to this current position Xenc.
  • the second correction unit 83 adjusts the speed setting value Vdes so that the corrected current position Xreal obtained approaches the ideal movement position Xdes. That is, the second correction unit 83 outputs the speed correction value VFB for correcting the speed setting value Vdes so that the difference between the corrected current position Xreal and the ideal movement position Xdes is small, and adjusts the value of the speed setting value Vdes. do.
  • the second correction unit 83 performs correction corresponding to errors such as thermal expansion and wear of the ball screw device that cannot be measured in advance. This correction adjusts the speed set value Vdes by feedback control so that there is no difference between the corrected current position Xreal and the ideal movement position Xdes.
  • the corrected current position Xreal after the first correction unit 81 has corrected an error that can be measured in advance is corrected. becomes smaller.
  • correction processing can be performed with a small gain, excessive adjustment such as overshoot and hunting is less likely to occur, and the speed setting value Vdes can be adjusted with high accuracy.
  • the correction order of the speed setting value Vdes by the speed correction value VFF by the first correction unit 81 and the speed correction value VFB by the second correction unit 83 may be whichever comes first.
  • position information of five axes is integrated for control.
  • a procedure for determining a command signal to instruct each driving device 10 in order to move the end effector to a desired target position and orientation will be described. do.
  • FIG. 11 is a control block diagram showing the details of processing by the second control method.
  • the tip position Xtip and the tip speed Vtip of the needle 25 in the end effector 21 shown in FIG. 1 are instructed as the command signal Sd.
  • the first integrated converter 89 obtains the speed set value Vact of the movable part of each driving device 10 according to these signals. Since the speed setting value Vact is the control of the five-axis parallel link robot 100 here, it is expressed as a five-dimensional matrix.
  • the speed set value Vact is corrected to the corrected speed set value V Tc of the five-dimensional matrix by the speed correction value V TF from the first overall correction section 91 and the speed correction value V TB from the second overall correction section 93, which will be described later. and input to each driving device 10 of the parallel link robot 100 .
  • each driving device 10 of the parallel link robot 100 drives the actuator according to the corresponding speed setting value from the inputted correction speed setting value V Tc , and the moving part detected by the position sensor 67 (FIG. 8). Output the current position.
  • the parallel link robot 100 puts together the current positions XTa of the movable parts of the drive devices 10 and outputs them in a five-dimensional matrix.
  • FIG. 12 is a control block diagram of the second integrated converter 95.
  • a signal of the current position XTa of each driving device 10 is input to the overall map section 96 .
  • the overall map unit 96 is a correction amount obtained by mapping the yawing direction error Yerr, the pitching direction error Perr, and the axial direction error Aerr in each driving device 10, which are the errors that can be measured in advance, for each position. Have a map.
  • the overall map unit 96 refers to the correction amount map, and in accordance with the input current position XTa of the movable portion of each drive device 10, the yawing direction error Yerr and the pitching direction error Yerr in each corresponding drive device 10.
  • the error Perr and the axial error Aerr are output to the first auxiliary converter 97 .
  • the errors Yerr, Perr, and Aerr and information on the target position Xact output from the first overall conversion section 89 (FIG. 11) are input to the first auxiliary conversion section 97 .
  • the second auxiliary conversion section 98 predicts the error of the tip position of the needle 25 in the end effector 21 from the input information, and outputs the error amount XTip to the second auxiliary conversion section 98 .
  • the second auxiliary converter 98 receives the error amount XTip, the target position Xact output from the first overall converter 89 , and the axial error Aerr output from the overall map module 96 .
  • the second auxiliary converter 98 outputs the feedforward control amount XTF of each driving device 10 from the input information.
  • This feedforward control amount XTF is input to the first overall correction section 91 shown in FIG.
  • the first overall correction section 91 obtains a speed correction value VTF corresponding to the input feedforward control amount XTF , and corrects the speed set value Vact output from the first overall conversion section 89 .
  • a corrected current position XTreal is obtained by correcting the current position XTa of the movable portion output from the parallel link robot 100 by the axial error Aerr corresponding to the current position XTa .
  • the second overall correction unit 93 adjusts the speed set value Vact so that the corrected current position XTreal approaches the target position Xact. That is, the second overall correction unit 93 corrects the velocity set value Vact so that the difference XTc between the corrected current position XTreal obtained by correcting the current position XTa with the error Aerr in the axial direction and the target position Xact becomes small. It outputs a speed correction value VTB to adjust the speed set value Vact.
  • the parallel link robot 100 with this configuration can accurately grasp the position of the tip (needle tip) of the end effector 21 by grasping the tip position of the movable part by each driving device 10 .
  • the attitude of the end effector can be controlled with an arbitrary point on the axis of the end effector 21 as the center of rotation by independent control of each driving device 10 .
  • RCM Remote Center of Motion
  • the present invention is applied to an ophthalmic surgical robot using a plurality of drive devices, but the application is not limited to this.
  • the present invention can be suitably applied to various robots such as medical robots, drug development robots, processing robots, etc., which require high precision in the position of the tip of the end effector.
  • a correction unit that corrects an input command signal to generate a correction signal, an actuator that advances and retreats a movable unit according to the correction signal, and a position sensor that detects the current position of the movable unit.
  • the actuator has a nut connected to the movable portion, a ball screw shaft to which the nut is screwed, and a pulse motor for rotationally driving the ball screw shaft;
  • the correction unit has a correction amount map in which a position correction amount for calibrating a predictable error due to the structure of the actuator is mapped for each position of the movable unit, and ideally moves the movable unit according to the command signal.
  • a driving device that generates the correction signal by correcting the command signal so that the difference from the ideal movement position is reduced.
  • the input command signal is corrected for the predictable error caused by the structure of the actuator using the correction amount map, and then corrected so that the difference from the ideal movement position becomes small. , the amount of correction in the latter correction process can be reduced. Therefore, correction processing can be performed with a small gain, and high position accuracy can be stably obtained.
  • the predictable error includes at least one of a lead error of the ball screw and a rotational error due to cogging of the pulse motor. According to this driving device, the lead error and the rotation error due to cogging can be corrected.
  • a correction unit that corrects an input command signal to generate a correction signal, an actuator that advances and retreats a movable portion according to the correction signal, and a position sensor that detects the current position of the movable portion; wherein the actuator has a nut connected to the movable part, a ball screw shaft to which the nut is screwed, and a pulse motor that rotationally drives the ball screw shaft.
  • the correction unit has a correction amount map in which a position correction amount for calibrating a predictable error due to the structure of the actuator is mapped for each position of the movable unit, and the command signal causes the movable unit to a step of estimating an ideal movement position to be moved; a step of obtaining the position correction amount corresponding to the current position detected by the position sensor by referring to the correction amount map; and correcting the current position with the position correction amount. and generating the correction signal obtained by correcting the command signal so that the difference between the corrected current position and the ideal movement position is reduced.
  • the input command signal is corrected for the predictable error caused by the structure of the actuator using the correction amount map, and then the difference from the ideal movement position is reduced. Since it is corrected, the amount of correction in the latter correction process can be reduced. Therefore, correction processing can be performed with a small gain, and high position accuracy can be stably obtained.
  • a correction unit that corrects an input command signal to generate a correction signal, an actuator that advances and retreats a movable portion according to the correction signal, and a position sensor that detects the current position of the movable portion;
  • a parallel link robot configured by using a plurality of drive devices and changing the position and orientation of a robot tip axis, wherein the actuator includes a nut connected to the movable part and a ball screw to which the nut is screwed. and a pulse motor that rotationally drives the ball screw shaft.
  • Each correction unit estimates an ideal movement position to which the movable unit moves according to the command signal, refers to the correction amount map, and controls the position sensor finds the position correction amount corresponding to the detected current position, and corrects the command signal so that the difference between the corrected current position obtained by correcting the current position with the position correction amount and the ideal movement position becomes small.
  • a parallel link robot that generates the correction signal. According to this parallel link robot, the speed and position of the tip end of the movable portion can be accurately controlled by the independent control device of each link portion, so that the speed and position of the tip shaft can be reliably determined. In addition, fine speed and position adjustment of the tip axis of the robot is possible by driving the pulse motor with the correction signal, and stable stationary and driving can be realized.
  • the plurality of driving devices include a first driving device and a second driving device arranged so that the forward and backward directions of the movable portions are parallel to each other, and the movable portions of the first driving device and the second driving device. are separated from each other and are tiltable by advancing and retracting the movable portion; and a fourth drive device, the third drive device and the movable portion of the fourth drive device are separated from each other and connected to each other, and a second connection member capable of tilting by advancing and retreating the movable portion, and the second connection member wherein the tilting axis of the first connecting member, the tilting axis of the second connecting member, and the advancing/retreating axis of the movable portion of the fifth driving device are orthogonal to each other.
  • the parallel link robot according to (6). According to this parallel link robot, drive control of five orthogonal axes can be performed with high position accuracy and high stability.
  • a correction unit that corrects an input command signal to generate a correction signal, an actuator that advances and retreats a movable portion according to the correction signal, and a position sensor that detects the current position of the movable portion;
  • a control method for a parallel link robot configured by using a plurality of driving devices provided with the actuator to change the position and orientation of a robot tip axis, wherein the actuator includes a nut connected to the movable part and a nut screwed together. and a pulse motor for rotationally driving the ball screw shaft, and the correction unit adjusts the position correction amount for calibrating a predictable error caused by the structure of the corresponding actuator.
  • the speed and position of the tip of the movable portion can be accurately controlled by the independent control device of each link, so that the speed and position of the tip axis can be reliably determined.
  • fine speed and position adjustment of the tip axis of the robot is possible by driving the pulse motor with the correction signal, and stable stationary and driving can be realized.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

駆動装置は、補正部とアクチュエータと位置センサとを備え、アクチュエータは、可動部に接続されたナットと、ナットが螺合されるボールねじ軸と、ボールねじ軸を回転駆動するパルスモータとを有する。補正部は、予測可能な誤差を校正する位置補正量が可動部の位置毎にマッピングされた補正量マップを有する。指令信号により可動部が移動する理想移動位置を推定し、補正量マップを参照して位置センサが検出した現在位置に対応する位置補正量を求める。そして、現在位置を位置補正量で補正した補正現在位置と、理想移動位置との差が小さくなるように指令信号を補正した補正信号を生成する。

Description

駆動装置及びその制御方法、並びにパラレルリンクロボット及びその制御方法
　本発明は、駆動装置及びその制御方法、並びにパラレルリンクロボット及びその制御方法に関する。
　パラレルリンクを使用したロボットは、一般的なシリアルリンクロボットに比べて位置決め精度、剛性等に優れるといった利点がある。しかし、ロボットを構成する各軸の位置決め誤差がロボットアームの先端位置の精度に大きな影響を及ぼすことになるため、このような位置決め誤差を低減する技術が検討されている。例えば、モータの回転を直線運動に変換するボールねじ装置を用いて可動部を移動させる際に、摩擦又はガタつき等により生じる可動部の位置決め誤差を補正する技術が知られている（特許文献１、２）。
特開２０１９－２８７８２号公報 特開平１１－１０５７５号公報
　特許文献１は、工作機械の可動部が移動方向を反転させる際に生じる位置誤差を補正するものであるが、ボールねじが持つリード誤差、及びパルスモータ特有のコギングによる影響について何ら考慮されていない。仮に、このような誤差をフィードバック制御によって補正する場合、ゲインを大きくしなければならず、システムが不安定になるおそれがある。また、特許文献1の構成はパラレルリンク機構ではなく、サーボモータとロータリーエンコーダを使用した駆動機構が採用されている。サーボモータは静止時の安定性に乏しいため、可動部の正確な位置決めを維持することは難しい。また、ロータリーエンコーダに加えてリニアエンコーダが使用されることで、複雑なシステム構成となっている。特許文献２は、パラレルリンク機構の技術ではあるが、各リンクを単純にフィードバック制御しているに過ぎない。そのため、前述したリード誤差、コギングによる誤差による影響を受けて、エンドエフェクタの先端を精密に位置決めすることは難しい。
　また、近年、外科手術における医者や患者の負担軽減から手術用のロボットが開発されている。特に眼科手術では、網膜等に刺針することが行われ、針先のμｍオーダーの正確な位置制御が要求される。上記のようなパラレルリンク機構を手術用のロボットに適用した場合には、各軸の高い絶対精度と安定性が求められることになる。
　そこで本発明は、構造を繁雑にすることなく、フィードバック制御の補正量を小さくしてエンドエフェクタの先端の位置を精密に且つ安定して制御できる駆動装置及びその制御方法、並びにパラレルリンクロボット及びその制御方法を提供することを目的とする。
（１）入力された指令信号を補正して補正信号を生成する補正部と、前記補正信号に応じて可動部を進退駆動するアクチュエータと、前記可動部の現在位置を検出する位置センサと、を備える駆動装置であって、前記アクチュエータは、前記可動部に接続されたナットと、前記ナットが螺合されるボールねじ軸と、前記ボールねじ軸を回転駆動するパルスモータと、を有し、前記補正部は、前記アクチュエータの構造に起因した予測可能な誤差を校正する位置補正量が前記可動部の位置毎にマッピングされた補正量マップを有し、前記指令信号により前記可動部が移動する理想移動位置を推定し、前記補正量マップを参照して前記位置センサが検出した前記現在位置に対応する前記位置補正量を求め、前記現在位置を前記位置補正量で補正した補正現在位置と、前記理想移動位置との差が小さくなるように前記指令信号を補正した前記補正信号を生成する、駆動装置。
（２）入力された指令信号を補正して補正信号を生成する補正部と、前記補正信号に応じて可動部を進退駆動するアクチュエータと、前記可動部の現在位置を検出する位置センサと、を備える駆動装置の制御方法であって、前記アクチュエータは、前記可動部に接続されたナットと、前記ナットが螺合されるボールねじ軸と、前記ボールねじ軸を回転駆動するパルスモータと、を有し、前記補正部は、前記アクチュエータの構造に起因した予測可能な誤差を校正する位置補正量が前記可動部の位置毎にマッピングされた補正量マップを有し、前記指令信号により前記可動部が移動する理想移動位置を推定する工程と、前記補正量マップを参照して前記位置センサが検出した前記現在位置に対応する前記位置補正量を求める工程と、前記現在位置を前記位置補正量で補正した補正現在位置と、前記理想移動位置との差が小さくなるように前記指令信号を補正した前記補正信号を生成する工程と、を有する、駆動装置の制御方法。
（３）入力された指令信号を補正して補正信号を生成する補正部と、前記補正信号に応じて可動部を進退駆動するアクチュエータと、前記可動部の現在位置を検出する位置センサと、を備える駆動装置を複数用いて構成され、ロボット先端軸の位置及び姿勢を変更するパラレルリンクロボットであって、前記アクチュエータは、前記可動部に接続されたナットと、前記ナットが螺合されるボールねじ軸と、前記ボールねじ軸を回転駆動するパルスモータと、それぞれを有し、前記補正部は、対応する前記アクチュエータの構造に起因した予測可能な誤差を校正する位置補正量が前記可動部の位置毎にマッピングされた補正量マップをそれぞれ有しており、前記補正部のそれぞれは、前記指令信号により前記可動部が移動する理想移動位置を推定し、前記補正量マップを参照して前記位置センサが検出した前記現在位置に対応する前記位置補正量を求め、前記現在位置を前記位置補正量で補正した補正現在位置と、前記理想移動位置との差が小さくなるように前記指令信号を補正した前記補正信号を生成する、パラレルリンクロボット。
（４）入力された指令信号を補正して補正信号を生成する補正部と、前記補正信号に応じて可動部を進退駆動するアクチュエータと、前記可動部の現在位置を検出する位置センサと、を備える駆動装置を複数用いて構成され、ロボット先端軸の位置及び姿勢を変更するパラレルリンクロボットの制御方法であって、前記アクチュエータは、前記可動部に接続されたナットと、前記ナットが螺合されるボールねじ軸と、前記ボールねじ軸を回転駆動するパルスモータと、それぞれを有し、前記補正部は、対応する前記アクチュエータの構造に起因した予測可能な誤差を校正する位置補正量が前記可動部の位置毎にマッピングされた補正量マップをそれぞれ有しており、前記指令信号により前記可動部が移動する理想移動位置を推定する工程と、前記補正量マップを参照して前記位置センサが検出した前記現在位置に対応する前記位置補正量を求める工程と、前記現在位置を前記位置補正量で補正した補正現在位置と、前記理想移動位置との差が小さくなるように前記指令信号を補正した前記補正信号を生成する工程と、を有する、パラレルリンクロボットの制御方法。
　本発明によれば、構造を繁雑にすることなく、フィードバック制御の補正量を小さくしてエンドエフェクタの先端の位置を精密に且つ安定して制御できる。
図１は、パラレルリンクロボットの正面斜視図である。 図２は、パラレルリンクロボットの背面斜視図である。 図３は、パラレルリンクロボットの上視図である。 図４は、パラレルリンクロボットの構成と動作を模式的に表した説明図である。 図５Ａは、第一リンク部１３が駆動した場合における針２５の移動の様子を示す図である。 図５Ｂは、図５Ａと反対方向に第一リンク部１３が駆動した場合における針２５の移動の様子を示す図である。 図６は、眼科手術時のエンドエフェクタの制御例を模式的に示す説明図である。 図７は、アクチュエータの誤差による影響を、第一リンク部を例に示す説明図である。 図８は、駆動装置の概略構成図である。 図９は、アクチュエータへ指示した指令位置と実際の移動位置との誤差を指令位置毎に示したグラフである。 図１０は、第１の制御方法による処理内容を示す制御ブロック図である。 図１１は、第２の制御方法による処理内容を示す制御ブロック図である。 図１２は、第二統括変換部の制御ブロック図である。
　以下、本発明に係る実施形態について、図面を参照して詳細に説明する。ここでは、可動部を進退移動させる複数の駆動装置を、眼科手術用のパラレルリンクロボットに適用した構成例を説明するが、駆動装置の適用例はこれに限らない。また、パラレルリンクロボットの用途もこれに限らない。
＜パラレルリンクロボットの構成＞
　図１は、パラレルリンクロボットの正面斜視図である。図２は、パラレルリンクロボットの背面斜視図である。図１に示すように、パラレルリンクロボット１００は、第一駆動装置１１Ａと第二駆動装置１１Ｂとを有する第一リンク部１３と、第三駆動装置１５Ａと第四駆動装置１５Ｂとを有する第二リンク部１７と、第五駆動装置１９と、第五駆動装置１９に設けられた眼科手術用のエンドエフェクタ２１と、統括制御部２３と、を備える。エンドエフェクタ２１は、先端に針（例えばカニューレなどの手術用器具）２５が設けられて第五駆動装置１９によって進退駆動される。
　図２に示すように、第一リンク部１３の第一駆動装置１１Ａは、可動部となる支持プレート３１Ａを第二リンク部１７に向けて進退移動させる。同様に、第二駆動装置１１Ｂは、可動部となる支持プレート３１Ｂを第二リンク部１７に向けて進退駆動させる。支持プレート３１Ａ，３１Ｂには、それぞれ支持部３３Ａ，３３Ｂが固定されている。
　支持プレート３１Ａ，３１Ｂに対向して第一接続部材３５が配置されている。第一接続部材３５の第一リンク部１３側の面には、ブラケット３７Ａ，３７Ｂが固定されている。ブラケット３７Ａは、支持プレート３１Ａの支持部３３Ａに回転自在に接続され、ブラケット３７Ｂは、支持プレート３１Ｂの支持部３３Ｂに回転自在に接続されている。
　第一接続部材３５の第一リンク部１３側と反対側の面には、第二リンク部１７の第三駆動装置１５Ａと第四駆動装置１５Ｂとが固定される。図１に示すように、第二リンク部１７の第三駆動装置１５Ａは、可動部となる支持プレート４１Ａを進退移動させる。同様に、第四駆動装置１５Ｂは、可動部となる支持プレート４１Ｂを進退駆動させる。支持プレート４１Ａ，４１Ｂには、それぞれ支持部４３Ａ，４３Ｂが固定されている。
　支持プレート４１Ａ，４１Ｂに対向して第二接続部材４５が配置されている。第二接続部材４５は、横断面がＬ字形の部材であり、第二接続部材４５の第二リンク部１７側の面には、ブラケット４７Ａ，４７Ｂが固定されている。ブラケット４７Ａは、支持プレート４１Ａの支持部４３Ａに回転自在に接続され、ブラケット４７Ｂは、支持プレート４１Ｂの支持部４３Ｂに回転自在に接続されている。第二接続部材４５は、断面Ｌ字形の一方の面には上記したブラケット４７Ａ，４７Ｂが固定されており、他方の面には第五駆動装置１９が固定される。
　図３は、パラレルリンクロボット１００の上視図である。ここで、第一リンク部１３の可動部の進退方向をＸ方向、第二リンク部１７の可動部の進退方向をＹ方向とし、Ｘ方向とＹ方向とに垂直な方向をＺ方向とする。ここでは、第一リンク部１３の進退方向を水平方向とし、Ｚ方向を鉛直方向として説明する。
　第一駆動装置１１Ａは、ロッド５１を進退駆動するアクチュエータ５３と、アクチュエータ５３を一軸方向にスライド自在に支持するスライダ５５とを備える。スライダ５５の一部には、前述した支持プレート３１Ａが固定されている。図示はしないが、第二駆動装置１１Ｂも同様の構成である。
　パラレルリンクロボット１００は、第一駆動装置１１Ａ及び第二駆動装置１１Ｂのアクチュエータ５３を基準として動作される。つまり、第一駆動装置１１Ａにおいては、アクチュエータ５３が不図示の固定部に固定され、スライダ５５とロッド５１とは、アクチュエータ５３に対してＸ方向にスライドして、支持プレート３１Ａと共に可動部となる。図示はしないが第二駆動装置１１Ｂについても同様である。また、第三駆動装置１５Ａ，第四駆動装置１５Ｂについても、アクチュエータ５３が第一接続部材３５に固定されている他は、同様の構成である。
　図４は、パラレルリンクロボット１００の構成と動作を模式的に表した説明図である。　第一駆動装置１１ＡによるＳ１方向の駆動又は第二駆動装置１１ＢによるＳ２方向の駆動によって、第一接続部材３５は軸線Ｌ１を中心に傾動（矢印Ｒ１方向）される。また、第三駆動装置１５ＡによるＳ３方向の駆動又は第四駆動装置１５ＢによるＳ４方向の駆動によって、第二接続部材４５は軸線Ｌ２を中心に傾動（矢印Ｒ２方向）される。これにより、第二接続部材４５に第五駆動装置１９を介して取り付けられたエンドエフェクタ２１の先端の針２５を、Ｒ１及びＲ２方向に移動できる。そして、第五駆動装置１９のＳ５方向の駆動が組み合わされることにより、針２５が３次元の任意方向に移動可能となる。
　つまり、このパラレルリンクロボット１００によれば、第一駆動装置１１Ａと第二駆動装置１１Ｂとの組、及び第三駆動装置１５Ａと第四駆動装置１５Ｂとの組の駆動装置により、エンドエフェクタ２１の先端の移動が可能となる。また、第五駆動装置１９により、エンドエフェクタ２１の先端の軸方向に沿った進退移動が可能となる。このように簡単な構成で安定したエンドエフェクタの制御が行える。また、各駆動装置の個別の動作により、精度の高い独立した位置制御ができ、エンドエフェクタ２１の先端の微細なコントロールが可能となる。
　図５Ａは、第一リンク部１３が駆動した場合における針２５の移動の様子を示す図である。図５Ｂは、図５Ａと反対方向に第一リンク部１３が駆動した場合における針２５の移動の様子を示す図である。図５Ａに示すように、第一リンク部１３の第一駆動装置１１Ａを矢印Ｘ１方向に駆動すると第一接続部材３５が傾動して、第一接続部材３５に固定された第二リンク部１７、第五駆動装置１９及びエンドエフェクタ１２が共に傾動する。また、図５Ｂに示すように、第一リンク部１３の第二駆動装置１１Ｂを矢印Ｘ２方向に駆動すると、第一接続部材３５が図５Ａに示す場合と逆向きに傾動して、第二リンク部１７、第五駆動装置１９及びエンドエフェクタ２１が共に傾動する。
　このような動作により、例えば、針２５の先端位置を中心にして鉛直方向からの角度θ１，θ２の揺動が行える。揺動中心は、第五駆動装置１９の針２５の繰り出しにより、適宜調整が可能である。
　本構成のパラレルリンクロボット１００によれば、５から６自由度でμｍオーダーの高い精度の動作が可能となる。このため、アクチュエータから遠隔の位置にある特定の点を中心として動作させる、いわゆるＲＣＭ（Ｒｅｍｏｔｅ　Ｃｅｎｔｅｒ　ｏｆ　Ｍｏｔｉｏｎ）制御が必要となる眼科手術用のロボットへの適用が可能となる。
＜アクチュエータの駆動による位置誤差＞
　図６は、眼科手術時のエンドエフェクタの制御例を模式的に示す説明図である。例えば、眼球５７の強膜５９に孔を開けて針２５を眼球内に挿入し、眼底５７ａの一部に処置を行う場合、眼球への侵入口６１を回転中心として針２５を制御する。このような場合、アクチュエータによる各軸の高い位置決め精度が必要となる。また、手術時のエンドエフェクタ２１の姿勢維持は非常に重要で、各軸が位置を安定して保持する必要がある。
　図７は、アクチュエータの誤差による影響を、第一リンク部１３を例に示す説明図である。第一駆動装置１１Ａと第二駆動装置１１Ｂとの駆動動作によって、前述した第一接続部材３５（図５参照）の傾動角度θ１，θ２が決定され、その傾動角度に応じて針２５の位置と姿勢が決定される。ここで、第一駆動装置１１Ａのアクチュエータ５３にΔＬ１の誤差が生じ、第二駆動装置１１Ｂのアクチュエータ５３にΔＬ２の誤差が生じた場合、誤差ΔＬ１，ΔＬ２の大きさが微少であっても、第一接続部材３５の傾動角度が大きく変化する。この角度の変動によって位置Ｏでの誤差はΔＬ３となり、誤差はアクチュエータ５３から離れた位置ほど拡大する。
　そこで、本構成のパラレルリンクロボット１００では、第一リンク部１３、第二リンク部１７及び第五駆動装置１９の各アクチュエータ５３をそれぞれ独立に制御して、位置誤差の発生を防止している。
＜アクチュエータの制御＞
　次に、各アクチュエータ５３の制御について説明する。上述した第一駆動装置１１Ａ、第二駆動装置１１Ｂ、第三駆動装置１５Ａ，第四駆動装置１５Ｂ、第五駆動装置１９は同一の構成であり、以下の説明ではこれらを纏めて駆動装置１０として説明する。
　図８は、駆動装置１０の概略構成図である。駆動装置１０は、入力された指令信号Ｓｄを補正して補正信号Ｓｃを生成するコントローラ６５と、補正信号Ｓｃに応じて可動部となるロッド５１を進退駆動するアクチュエータ５３と、可動部であるロッド５１の現在位置を検出する位置センサ６７と、を備える。ここでは、位置センサ６７としてスケール６７ａと読取り部６７ｂとを備えるリニアエンコーダを用いている。リニアエンコーダを用いることで、可動部の移動をその移動方向に沿って直接検出でき、高精度な検出が可能となる。コントローラ６５と位置センサ６７とは、アクチュエータ５３の筐体５３ａ内に配置さていてもよく、筐体５３ａの側に配置されていてもよい。
　アクチュエータ５３は、ロッド５１に接続されたナット６９と、ナット６９が螺合されるボールねじ軸７１と、ボールねじ軸７１を回転駆動するパルスモータ７３と、を有する。図８においては、ボールねじ軸７１が回転自在に支持され、ナット６９が移動する構成であるが、ナットをパルスモータに回転可能に固定して、ボールねじ軸を移動させる構成としてもよい。その場合、アクチュエータをよりコンパクトにできる。
　パルスモータ７３は、ステッピングモータであることが好ましい。ステッピングモータは、サーボモータと比較して静止時の安定性が高く、サーボモータの回転を検出するロータリーエンコーダを設けなくてよいので、構成を簡略化できる。また、ピエゾアクチュエータと比較して、医療機器に適した低電圧で駆動可能となる。さらに、シャフトモータと比較して、供給電源をＯＦＦにした場合でもボールねじ軸７１とナット６９との摩擦力によって静止状態を維持でき、ロボットの姿勢を安定して保持できる。
　しかし、パルスモータ７３にはコギングによる位置誤差が存在し、ボールねじ軸７１とナット６９とを有するボールねじ装置にはリード誤差が存在する。図９は、アクチュエータへ指示した指令位置と実際の移動位置との誤差を指令位置毎に示したグラフである。図９に示す指令位置と実際の移動位置のバラつきを表す誤差は、ボールねじ装置のリード誤差がモータ１回転毎に数μｍｍから十数μｍで発生し、パルスモータ７３のコギングによってモータ１回転毎に数十から数百回、数μｍの振動が発生することに起因する。図９に示す場合には、誤差ΔＳが約２０μｍ生じている。
　上記のボールねじ装置のリード誤差とパルスモータのコギングとの誤差は、予め測定可能な誤差であり、制御に先立って、アクチュエータの駆動による可動部の移動位置に対する誤差を校正する位置補正量をマッピングした補正量マップを構築しておくことで、この誤差を補正できる。一方、ボールねじ装置の熱膨張、摩耗等に起因する誤差は、予め測定することはできない。
＜第１の制御方法＞
　本パラレルリンクロボット１００の第１の制御方法では、アクチュエータへの指令を、予め測定可能な誤差と、予め測定できない誤差とに分けて補正する。即ち、指令信号で指示する目標位置の情報を、予め測定可能な誤差については、マッピングした補正量マップを参照して、位置センサ６７から得られる位置情報に応じた位置補正値を求めてフィードフォワード制御により補正し、予め測定できない誤差については、フィードバック制御により補正する。
　図８に示すアクチュエータ５３が備えるパルスモータ７３は、駆動装置１０に入力された指令信号Ｓｄの速度設定値Ｖｄｅｓを所定の手順で補正した速度補正値Ｖｃを含む補正信号Ｓｃによって駆動される。
　図１０は、第１の制御方法による処理内容を示す制御ブロック図である。速度設定値Ｖｄｅｓは、詳細を後述する第一補正部８１からの速度補正値ＶＦＦによるフィードフォワード制御と、詳細を後述する第二補正部８３からの速度補正値ＶＦＢによるフィードバック制御と、により補正され、補正後の速度補正値Ｖｃの信号がコントローラ６５に入力される。
　コントローラ６５は、入力された速度補正値Ｖｃの信号に応じて図８に示すパルスモータ７３を駆動する。これにより、ボールねじ軸７１及びナット６９を介して可動部であるロッド５１が移動する。このロッド５１の移動を位置センサ６７により検出した可動部の現在位置Ｘｅｎｃがコントローラ６５から出力される。
　コントローラ６５から出力された現在位置Ｘｅｎｃは、マップ部８５に入力される。マップ部８５は、予め測定可能な誤差であるリード誤差及びコギングによる誤差が、可動部の位置毎にマッピングされた補正量マップを備えている。マップ部８５は、補正量マップを参照して現在位置Ｘｅｎｃに対応する位置補正量Ｘｅｒｒを出力する。
　位置補正量Ｘｅｒｒは第一補正部８１に入力される。第一補正部８１は、予め発生することが分かっている誤差量である位置補正量Ｘｅｒｒ分の補正処理を、速度設定値Ｖｄｅｓに対して実施する。つまり、第一補正部８１は、位置補正量Ｘｅｒｒで表される誤差を０にするように速度設定値Ｖｄｅｓを調整するための速度補正値ＶＦＦを算出する。換言すると、第一補正部８１は、フィードフォワード制御によって位置補正量Ｘｅｒｒに応じて速度設定値Ｖｄｅｓの値を調整する。
　また、コントローラ６５に入力される速度設定値Ｖｄｅｓは、変換部８７にも入力される。変換部８７は、入力された速度設定値Ｖｄｅｓに基づいてアクチュエータが駆動された場合の可動部の理想移動位置Ｘｄｅｓを推定する。
　そして、コントローラ６５から出力された可動部の現在位置Ｘｅｎｃを、この現在位置Ｘｅｎｃに対応する位置補正量Ｘｅｒｒで補正した補正現在位置Ｘｒｅａｌを求める。第二補正部８３は、求めた補正現在位置Ｘｒｅａｌが理想移動位置Ｘｄｅｓに近づくように速度設定値Ｖｄｅｓの値を調整する。つまり、第二補正部８３は、補正現在位置Ｘｒｅａｌと理想移動位置Ｘｄｅｓとの差が小さくなるように、速度設定値Ｖｄｅｓを補正する速度補正値ＶＦＢを出力し、速度設定値Ｖｄｅｓの値を調整する。
　つまり、第二補正部８３では、ボールねじ装置の熱膨張、摩耗等の予め測定できない誤差に対応する補正が実施される。この補正は、補正現在位置Ｘｒｅａｌと理想移動位置Ｘｄｅｓとの差が生じないように、速度設定値Ｖｄｅｓをフィードバック制御により調整する。
　上記した第二補正部８３での補正処理は、第一補正部８１によって、予め測定できる誤差分を補正した後の補正現在位置Ｘｒｅａｌを補正対象とするため、第二補正部８３での補正量が小さくなる。その結果、小さいゲインで補正処理が行え、オーバーシュートやハンチング等の過剰な調整が生じにくくなり、高い精度で速度設定値Ｖｄｅｓの調整が可能となる。
　なお、上記した第一補正部８１による速度補正値ＶＦＦと、第二補正部８３による速度補正値ＶＦＢとによる速度設定値Ｖｄｅｓの補正順序は、どちらが先であってもよい。
＜第２の制御方法＞
　次に、第２の制御方法について説明する。前述した第１の制御方法では、各軸の軸方向の精度は担保されるが、アクチュエータは軸方向だけでなくピッチング、ヨーイング運動しながら前後する（上下左右に揺れながら前後する）ため、その補正は単軸で行う第１の制御方法では行えない。また、軸方向の誤差ではないため、位置センサ６７により検出できない誤差となる。そのため、ピッチング、ヨーイング運動により生じる誤差は、他の軸により補正させる必要がある。
　そこで、第２の制御方法では、５軸の位置情報を統合して制御する。ここでは、複数の駆動装置１０が組み合わされた多軸のパラレルリンクロボットにおいて、エンドエフェクタを所望の目標位置及び姿勢に移動させるために、各駆動装置１０に指示する指令信号を決定する手順を説明する。
　図１１は、第２の制御方法による処理内容を示す制御ブロック図である。ここでは、指令信号Ｓｄとして、図１に示すエンドエフェクタ２１における針２５の先端位置Ｘｔｉｐと針先速度Ｖｔｉｐが指示される。第一統括変換部８９は、先端位置Ｘｔｉｐと針先速度Ｖｔｉｐの信号が入力されると、これら信号に応じて各駆動装置１０の可動部の速度設定値Ｖａｃｔを求める。速度設定値Ｖａｃｔは、ここでは５軸のパラレルリンクロボット１００の制御であるため、５次元マトリクスとして表される。
　速度設定値Ｖａｃｔは、後述する第一統括補正部９１からの速度補正値ＶＴＦ及び第二統括補正部９３からの速度補正値ＶＴＢによって、５次元マトリクスの補正速度設定値ＶＴｃに補正されて、パラレルリンクロボット１００の各駆動装置１０に入力される。
　そして、パラレルリンクロボット１００の各駆動装置１０は、入力された補正速度設定値ＶＴｃから、対応する速度設定値に応じてアクチュエータを駆動し、位置センサ６７（図８）により検出した可動部の現在位置を出力する。パラレルリンクロボット１００は、各駆動装置１０の可動部の現在位置ＸＴａを纏め、５次元マトリクスにして出力する。
　この現在位置ＸＴａの情報は、第二統括変換部９５に入力される。図１２は、第二統括変換部９５の制御ブロック図である。各駆動装置１０の現在位置ＸＴａの信号が統括マップ部９６に入力される。統括マップ部９６は、前述した予め測定可能な誤差である、各駆動装置１０におけるヨーイング方向の誤差Ｙｅｒｒと、ピッチング方向の誤差Ｐｅｒｒと、軸方向の誤差Ａｅｒｒとが位置毎にマッピングされた補正量マップを備える。
　統括マップ部９６は、補正量マップを参照して、入力された各駆動装置１０の可動部の現在位置ＸＴａに応じて、対応する各駆動装置１０におけるヨーイング方向の誤差Ｙｅｒｒと、ピッチング方向の誤差Ｐｅｒｒと、軸方向の誤差Ａｅｒｒとを第一補助変換部９７に出力する。
　第一補助変換部９７には、誤差Ｙｅｒｒ、Ｐｅｒｒ、Ａｅｒｒと、第一統括変換部８９（図１１）から出力される目標位置Ｘａｃｔの情報が入力される。第二補助変換部９８は、これら入力された情報からエンドエフェクタ２１における針２５の先端位置の誤差を予測して、その誤差量ＸＴｉｐを第二補助変換部９８に出力する。
　第二補助変換部９８には、誤差量ＸＴｉｐと、第一統括変換部８９から出力された目標位置Ｘａｃｔと、統括マップ部９６から出力された軸方向の誤差Ａｅｒｒが入力される。第二補助変換部９８は、これら入力された情報から各駆動装置１０のフィードフォワード制御量ＸＴＦを出力する。
　このフィードフォワード制御量ＸＴＦは、図１１に示す第一統括補正部９１に入力される。第一統括補正部９１は、入力されたフィードフォワード制御量ＸＴＦに応じた速度補正値ＶＴＦを求め、第一統括変換部８９から出力される速度設定値Ｖａｃｔを補正する。
　また、パラレルリンクロボット１００から出力された可動部の現在位置ＸＴａを、この現在位置ＸＴａに対応する軸方向の誤差Ａｅｒｒで補正した補正現在位置ＸＴｒｅａｌを求める。第二統括補正部９３は、補正現在位置ＸＴｒｅａｌが、目標とする目標位置Ｘａｃｔに近づくように速度設定値Ｖａｃｔの値を調整する。つまり、第二統括補正部９３は、現在位置ＸＴａを軸方向の誤差Ａｅｒｒで補正した補正現在位置ＸＴｒｅａｌと、目標位置Ｘａｃｔとの差ＸＴｃが小さくなるように、速度設定値Ｖａｃｔを補正する速度補正値ＶＴＢを出力し、速度設定値Ｖａｃｔを調整する。
　本構成によれば、アクチュエータがピッチング、ヨーイング運動しながら前後する場合であっても、その影響を他の軸で補正することができ、高精度な制御が可能となる。
　以上説明したように、本構成のパラレルリンクロボット１００は、各駆動装置１０による可動部の先端位置の把握により、エンドエフェクタ２１の先端（針先）の位置を正確に把握できる。これにより、例えば、個々の駆動装置１０の独立した制御により、エンドエフェクタ２１の軸線上の任意の点を回転中心として、エンドエフェクタの姿勢を制御できる。つまり、駆動装置１０から遠隔した位置にある点を中心として動作させるＲＣＭ（Ｒｅｍｏｔｅ　Ｃｅｎｔｅｒ　ｏｆ　Ｍｏｔｉｏｎ）制御を高精度で安定して実現できる。
　本発明は上記の実施形態に限定されるものではなく、実施形態の各構成を相互に組み合わせることや、明細書の記載、並びに周知の技術に基づいて、当業者が変更、応用することも本発明の予定するところであり、保護を求める範囲に含まれる。
　上記の説明では、本発明を、複数の駆動装置を用いた眼科手術用ロボットに適用した一例を示したが、適用例はこれに限らない。例えば、エンドエフェクタの先端位置の高い精度が要求される、医療、薬品開発用ロボット、加工用ロボット等の種々のロボットにも好適に適用できる。
　以上の通り、本明細書には次の事項が開示されている。
（１）入力された指令信号を補正して補正信号を生成する補正部と、前記補正信号に応じて可動部を進退駆動するアクチュエータと、前記可動部の現在位置を検出する位置センサと、を備える駆動装置であって、前記アクチュエータは、前記可動部に接続されたナットと、前記ナットが螺合されるボールねじ軸と、前記ボールねじ軸を回転駆動するパルスモータと、を有し、前記補正部は、前記アクチュエータの構造に起因した予測可能な誤差を校正する位置補正量が前記可動部の位置毎にマッピングされた補正量マップを有し、前記指令信号により前記可動部が移動する理想移動位置を推定し、前記補正量マップを参照して前記位置センサが検出した前記現在位置に対応する前記位置補正量を求め、前記現在位置を前記位置補正量で補正した補正現在位置と、前記理想移動位置との差が小さくなるように前記指令信号を補正した前記補正信号を生成する、駆動装置。この駆動装置によれば、入力された指令信号を、アクチュエータの構造に起因する予測可能な誤差について補正量マップを用いて補正し、その後、理想移動位置との差が小さくなるように補正するため、後者の補正処理における補正量を小さくできる。よって、小さいゲインで補正処理を行え、安定して高い位置精度が得られる。
（２）前記予測可能な誤差は、前記ボールねじのリード誤差と、前記パルスモータのコギングによる回転誤差との少なくとも一方を含む、（１）に記載の駆動装置。この駆動装置によれば、リード誤差と、コギングによる回転誤差を補正できる。
（３）前記位置センサは、リニアエンコーダである、（１）又は（２）に記載の駆動装置。この駆動装置によれば、可動部の移動をその移動方向に沿って直接検出でき、高精度な検出が可能となる。
（４）前記パルスモータは、ステッピングモータである、（１）から（３）のいずれか１つに記載の駆動装置。この駆動装置によれば、静止時の安定性を高め、回転を検出するロータリーエンコーダが不要となるため構成を簡略化できる。また、定電圧で駆動可能であり、且つ供給電源をＯＦＦにした場合でも静止状態を維持でき、ロボットの姿勢を安定して保持できる。
（５）入力された指令信号を補正して補正信号を生成する補正部と、前記補正信号に応じて可動部を進退駆動するアクチュエータと、前記可動部の現在位置を検出する位置センサと、を備える駆動装置の制御方法であって、前記アクチュエータは、前記可動部に接続されたナットと、前記ナットが螺合されるボールねじ軸と、前記ボールねじ軸を回転駆動するパルスモータと、を有し、前記補正部は、前記アクチュエータの構造に起因した予測可能な誤差を校正する位置補正量が前記可動部の位置毎にマッピングされた補正量マップを有し、前記指令信号により前記可動部が移動する理想移動位置を推定する工程と、前記補正量マップを参照して前記位置センサが検出した前記現在位置に対応する前記位置補正量を求める工程と、前記現在位置を前記位置補正量で補正した補正現在位置と、前記理想移動位置との差が小さくなるように前記指令信号を補正した前記補正信号を生成する工程と、を有する、駆動装置の制御方法。この駆動装置の制御方法によれば、入力された指令信号を、アクチュエータの構造に起因する予測可能な誤差について補正量マップを用いて補正し、その後、理想移動位置との差が小さくなるように補正するため、後者の補正処理における補正量を小さくできる。よって、小さいゲインで補正処理を行え、安定して高い位置精度が得られる。
（６）入力された指令信号を補正して補正信号を生成する補正部と、前記補正信号に応じて可動部を進退駆動するアクチュエータと、前記可動部の現在位置を検出する位置センサと、を備える駆動装置を複数用いて構成され、ロボット先端軸の位置及び姿勢を変更するパラレルリンクロボットであって、前記アクチュエータは、前記可動部に接続されたナットと、前記ナットが螺合されるボールねじ軸と、前記ボールねじ軸を回転駆動するパルスモータと、それぞれを有し、前記補正部は、対応する前記アクチュエータの構造に起因した予測可能な誤差を校正する位置補正量が前記可動部の位置毎にマッピングされた補正量マップをそれぞれ有しており、前記補正部のそれぞれは、前記指令信号により前記可動部が移動する理想移動位置を推定し、前記補正量マップを参照して前記位置センサが検出した前記現在位置に対応する前記位置補正量を求め、前記現在位置を前記位置補正量で補正した補正現在位置と、前記理想移動位置との差が小さくなるように前記指令信号を補正した前記補正信号を生成する、パラレルリンクロボット。このパラレルリンクロボットによれば、各リンク部の独立した制御装置により可動部の先端の速度及び位置を精度よく制御できることで、先端軸の速度及び位置が確実に定まる。また、パルスモータの補正信号による駆動によってロボット先端軸の微細な速度及び位置調整が可能となり、安定した静止及び駆動が実現できる。
（７）複数の前記駆動装置は、前記可動部の進退方向を互いに平行にして配置された第一駆動装置及び第二駆動装置と、前記第一駆動装置と前記第二駆動装置の前記可動部とが互いに離れて接続され、当該可動部の進退によって傾動可能な第一接続部材と、前記第一接続部材に設けられ、前記可動部の進退方向を互いに平行にして配置された第三駆動装置及び第四駆動装置と、前記第三駆動装置と前記第四駆動装置の前記可動部とが互いに離れて接続され、当該可動部の進退によって傾動可能な第二接続部材と、前記第二接続部材に設けられた第五駆動装置と、を備え、前記第一接続部材の傾動軸と、前記第二接続部材の傾動軸と、前記第五駆動装置の前記可動部の進退軸とが互いに直交している、（６）に記載のパラレルリンクロボット。このパラレルリンクロボットによれば、直交５軸の駆動制御が高い位置精度で且つ高い安定性で行える。
（８）前記ロボット先端軸にエンドエフェクタが設けられた、（７）に記載のパラレルリンクロボット。このパラレルリンクロボットによれば、エンドエフェクタを高精度に位置決めできる。
（９）前記エンドエフェクタは、眼科手術用の処置具が装着される、（８）に記載のパラレルリンクロボット。このパラレルリンクロボットによれば、高い精度で高い安定性が得られる駆動が可能となる。
（１０）入力された指令信号を補正して補正信号を生成する補正部と、前記補正信号に応じて可動部を進退駆動するアクチュエータと、前記可動部の現在位置を検出する位置センサと、を備える駆動装置を複数用いて構成され、ロボット先端軸の位置及び姿勢を変更するパラレルリンクロボットの制御方法であって、前記アクチュエータは、前記可動部に接続されたナットと、前記ナットが螺合されるボールねじ軸と、前記ボールねじ軸を回転駆動するパルスモータと、それぞれを有し、前記補正部は、対応する前記アクチュエータの構造に起因した予測可能な誤差を校正する位置補正量が前記可動部の位置毎にマッピングされた補正量マップをそれぞれ有しており、前記指令信号により前記可動部が移動する理想移動位置を推定する工程と、前記補正量マップを参照して前記位置センサが検出した前記現在位置に対応する前記位置補正量を求める工程と、前記現在位置を前記位置補正量で補正した補正現在位置と、前記理想移動位置との差が小さくなるように前記指令信号を補正した前記補正信号を生成する工程と、を有する、パラレルリンクロボットの制御方法。このパラレルリンクロボットの制御方法によれば、各リンク部の独立した制御装置により可動部の先端の速度及び位置を精度よく制御できることで、先端軸の速度及び位置が確実に定まる。また、パルスモータの補正信号による駆動によってロボット先端軸の微細な速度及び位置調整が可能となり、安定した静止及び駆動が実現できる。
　１０　駆動装置
　１１Ａ　第一駆動装置
　１１Ｂ　第二駆動装置
　１３　第一リンク部
　１５Ａ　第三駆動装置
　１５Ｂ　第四駆動装置
　１７　第二リンク部
　１９　第五駆動装置
　２１　エンドエフェクタ
　２３　統括制御部
　２５　針
　３１Ａ，３１Ｂ　支持プレート
　３３Ａ，３３Ｂ　支持部
　３５　第一接続部材
　３７Ａ，３７Ｂ　ブラケット
　４１Ａ，４１Ｂ　支持プレート
　４３Ａ，４３Ｂ　支持部
　４５　第二接続部材
　４７Ａ，４７Ｂ　ブラケット
　５１　ロッド
　５３　アクチュエータ
　５３ａ　筐体
　５５　スライダ
　５７　眼球
　５７ａ　眼底
　５９　強膜
　６１　侵入口
　６５　コントローラ
　６７　位置センサ
　６７ａ　スケール
　６７ｂ　読取り部
　６９　ナット
　７１　ボールねじ軸
　７３　パルスモータ
　８１　第一補正部
　８３　第二補正部
　８５　マップ部
　８７　変換部
　８９　第一統括変換部
　９１　第一統括補正部
　９３　第二統括補正部
　９５　第二統括変換部
　９６　統括マップ部
　９７　第一補助変換部
　９８　第二補助変換部
１００　パラレルリンクロボット　

Claims (10)

  1. 　入力された指令信号を補正して補正信号を生成する補正部と、前記補正信号に応じて可動部を進退駆動するアクチュエータと、前記可動部の現在位置を検出する位置センサと、
    を備える駆動装置であって、
    　前記アクチュエータは、前記可動部に接続されたナットと、前記ナットが螺合されるボールねじ軸と、前記ボールねじ軸を回転駆動するパルスモータと、を有し、
    　前記補正部は、前記アクチュエータの構造に起因した予測可能な誤差を校正する位置補正量が前記可動部の位置毎にマッピングされた補正量マップを有し、
    　前記指令信号により前記可動部が移動する理想移動位置を推定し、
    　前記補正量マップを参照して前記位置センサが検出した前記現在位置に対応する前記位置補正量を求め、
    　前記現在位置を前記位置補正量で補正した補正現在位置と、前記理想移動位置との差が小さくなるように前記指令信号を補正した前記補正信号を生成する、
    駆動装置。
  2. 　前記予測可能な誤差は、前記ボールねじのリード誤差と、前記パルスモータのコギングによる回転誤差との少なくとも一方を含む、請求項１に記載の駆動装置。
  3. 　前記位置センサは、リニアエンコーダである、
    請求項１又は２に記載の駆動装置。
  4. 　前記パルスモータは、ステッピングモータである、
    請求項１から３のいずれか１項に記載の駆動装置。
  5. 　入力された指令信号を補正して補正信号を生成する補正部と、前記補正信号に応じて可動部を進退駆動するアクチュエータと、前記可動部の現在位置を検出する位置センサと、を備える駆動装置の制御方法であって、
    　前記アクチュエータは、前記可動部に接続されたナットと、前記ナットが螺合されるボールねじ軸と、前記ボールねじ軸を回転駆動するパルスモータと、を有し、
    　前記補正部は、前記アクチュエータの構造に起因した予測可能な誤差を校正する位置補正量が前記可動部の位置毎にマッピングされた補正量マップを有し、
    　前記指令信号により前記可動部が移動する理想移動位置を推定する工程と、
    　前記補正量マップを参照して前記位置センサが検出した前記現在位置に対応する前記位置補正量を求める工程と、
    　前記現在位置を前記位置補正量で補正した補正現在位置と、前記理想移動位置との差が小さくなるように前記指令信号を補正した前記補正信号を生成する工程と、
    を有する、駆動装置の制御方法。
  6. 　入力された指令信号を補正して補正信号を生成する補正部と、前記補正信号に応じて可動部を進退駆動するアクチュエータと、前記可動部の現在位置を検出する位置センサと、を備える駆動装置を複数用いて構成され、ロボット先端軸の位置及び姿勢を変更するパラレルリンクロボットであって、
    　前記アクチュエータは、前記可動部に接続されたナットと、前記ナットが螺合されるボールねじ軸と、前記ボールねじ軸を回転駆動するパルスモータと、それぞれを有し、
    　前記補正部は、対応する前記アクチュエータの構造に起因した予測可能な誤差を校正する位置補正量が前記可動部の位置毎にマッピングされた補正量マップをそれぞれ有しており、
    　前記補正部のそれぞれは、
    　前記指令信号により前記可動部が移動する理想移動位置を推定し、
    　前記補正量マップを参照して前記位置センサが検出した前記現在位置に対応する前記位置補正量を求め、
    　前記現在位置を前記位置補正量で補正した補正現在位置と、前記理想移動位置との差が小さくなるように前記指令信号を補正した前記補正信号を生成する、
    パラレルリンクロボット。
  7. 　複数の前記駆動装置は、
    　前記可動部の進退方向を互いに平行にして配置された第一駆動装置及び第二駆動装置と、
    　前記第一駆動装置と前記第二駆動装置の前記可動部とが互いに離れて接続され、当該可動部の進退によって傾動可能な第一接続部材と、
    　前記第一接続部材に設けられ、前記可動部の進退方向を互いに平行にして配置された第三駆動装置及び第四駆動装置と、
    　前記第三駆動装置と前記第四駆動装置の前記可動部とが互いに離れて接続され、当該可動部の進退によって傾動可能な第二接続部材と、
    　前記第二接続部材に設けられた第五駆動装置と、
    を備え、
    　前記第一接続部材の傾動軸と、前記第二接続部材の傾動軸と、前記第五駆動装置の前記可動部の進退軸とが互いに直交している、
    請求項６に記載のパラレルリンクロボット。
  8. 　前記ロボット先端軸にエンドエフェクタが設けられた、
    請求項７に記載のパラレルリンクロボット。
  9. 　前記エンドエフェクタは、眼科手術用の処置具が装着される、
    請求項８に記載のパラレルリンクロボット。
  10. 　入力された指令信号を補正して補正信号を生成する補正部と、前記補正信号に応じて可動部を進退駆動するアクチュエータと、前記可動部の現在位置を検出する位置センサと、を備える駆動装置を複数用いて構成され、ロボット先端軸の位置及び姿勢を変更するパラレルリンクロボットの制御方法であって、
    　前記アクチュエータは、前記可動部に接続されたナットと、前記ナットが螺合されるボールねじ軸と、前記ボールねじ軸を回転駆動するパルスモータと、それぞれを有し、
    　前記補正部は、対応する前記アクチュエータの構造に起因した予測可能な誤差を校正する位置補正量が前記可動部の位置毎にマッピングされた補正量マップをそれぞれ有しており、
    　前記指令信号により前記可動部が移動する理想移動位置を推定する工程と、
    　前記補正量マップを参照して前記位置センサが検出した前記現在位置に対応する前記位置補正量を求める工程と、
    　前記現在位置を前記位置補正量で補正した補正現在位置と、前記理想移動位置との差が小さくなるように前記指令信号を補正した前記補正信号を生成する工程と、
    を有する、パラレルリンクロボットの制御方法。 
PCT/JP2021/044324 2021-07-19 2021-12-02 駆動装置及びその制御方法、並びにパラレルリンクロボット及びその制御方法 WO2023002642A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2022516459A JP7088440B1 (ja) 2021-07-19 2021-12-02 駆動装置及びその制御方法、並びにパラレルリンクロボット及びその制御方法
EP21950991.6A EP4375029A1 (en) 2021-07-19 2021-12-02 Drive device, method for controlling drive device, parallel link robot, and method for controlling parallel rink robot
US17/921,173 US11766778B2 (en) 2021-07-19 2021-12-02 Driving device and method for controlling the same, and parallel link robot and method for controlling the same

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2021-118751 2021-07-19
JP2021118751 2021-07-19

Publications (1)

Publication Number Publication Date
WO2023002642A1 true WO2023002642A1 (ja) 2023-01-26

Family

ID=84979057

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/044324 WO2023002642A1 (ja) 2021-07-19 2021-12-02 駆動装置及びその制御方法、並びにパラレルリンクロボット及びその制御方法

Country Status (1)

Country Link
WO (1) WO2023002642A1 (ja)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1110575A (ja) 1997-06-26 1999-01-19 Toshiba Mach Co Ltd パラレルリンク機構
WO2001063730A1 (fr) * 2000-02-25 2001-08-30 Mitsubishi Denki Kabushiki Kaisha Servomoteur cylindrique
JP2006266999A (ja) * 2005-03-25 2006-10-05 Nsk Ltd 角度位置検出装置及び方法
US20100331858A1 (en) * 2008-01-30 2010-12-30 The Trustees Of Columbia University In The City Of New York Systems, devices, and methods for robot-assisted micro-surgical stenting
JP2019028782A (ja) 2017-07-31 2019-02-21 オークマ株式会社 位置制御装置

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1110575A (ja) 1997-06-26 1999-01-19 Toshiba Mach Co Ltd パラレルリンク機構
WO2001063730A1 (fr) * 2000-02-25 2001-08-30 Mitsubishi Denki Kabushiki Kaisha Servomoteur cylindrique
JP2006266999A (ja) * 2005-03-25 2006-10-05 Nsk Ltd 角度位置検出装置及び方法
US20100331858A1 (en) * 2008-01-30 2010-12-30 The Trustees Of Columbia University In The City Of New York Systems, devices, and methods for robot-assisted micro-surgical stenting
JP2019028782A (ja) 2017-07-31 2019-02-21 オークマ株式会社 位置制御装置

Similar Documents

Publication Publication Date Title
US10369708B2 (en) Apparatus and method for providing an adjustable positive stop in space
US6216056B1 (en) Method of controlling force assisting device and control apparatus using the same
EP2889015B1 (en) Handheld robot for orthopedic surgery
US5410638A (en) System for positioning a medical instrument within a biotic structure using a micromanipulator
US7646161B2 (en) Method for controlling a robot arm, and robot for implementing the method
US6968264B2 (en) Method and system for controlling a mechanical arm
EP3946833B1 (en) Reducing energy buildup in servo-controlled mechanisms
EP3052042B1 (en) System for interacting with an object
WO2018159114A1 (ja) 制御システム及び制御方法、並びに手術アームシステム
CN109954955B (zh) 机器人***
EP3938152A1 (en) Guided tool change
CN113715029B (zh) 一种机械臂控制方法的自主学习方法
CN114176902B (zh) 一种机器人自动补偿运动控制方法
WO2023002642A1 (ja) 駆動装置及びその制御方法、並びにパラレルリンクロボット及びその制御方法
US20220096188A1 (en) Systems and methods for tracking anatomical motion
JP7088440B1 (ja) 駆動装置及びその制御方法、並びにパラレルリンクロボット及びその制御方法
KR20200145377A (ko) 슬레이브 장치 및 이를 제어하는 방법
JP2003071760A (ja) 組立ロボット
Muñoz et al. Adaptive cartesian motion control approach for a surgical robotic cameraman
CN114505859B (zh) 一种种植牙手术机器人末端柔顺控制方法
CA2974996C (en) Navigation by bending forces
US20230270515A1 (en) Robotic surgical system, control device of robotic surgical system, and control method of robotic surgical system
JP2020120764A (ja) 手術支援装置
JPH06142967A (ja) レーザロボットのレーザヘッド補正方法
WO2023237746A1 (en) Robotic surgical system

Legal Events

Date Code Title Description
ENP Entry into the national phase

Ref document number: 2022516459

Country of ref document: JP

Kind code of ref document: A

121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 21950991

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 2021950991

Country of ref document: EP

NENP Non-entry into the national phase

Ref country code: DE

ENP Entry into the national phase

Ref document number: 2021950991

Country of ref document: EP

Effective date: 20240219