Patent Application
20240115336
The present invention relates to a method and system for initiating a teleoperation carried out by means of a robotic system for medical or surgical teleoperation.
In particular, the invention relates to a method and system for initiating a teleoperation carried out by means of a robotic system for master-slave surgical teleoperation, having a master device which is mechanically unconstrained and movable by an operator.
In the field of master-slave robotic systems for medical or surgical teleoperation, master consoles are known with a mechanically constrained and motorized leg which acts as a “master controller” device.
In such cases, when exiting the teleoperation state, the orientation of the master devices is locked and kept constantly aligned with the slave devices; it can also occur that the master device is moved by motors so as to ensure the complete correspondence of the orientation of the master device with that of the slave device.
If this alignment in orientation between master and slave is not performed, the control of the slave would be hardly intuitive and not ergonomic.
An example of a master-slave robotic system having a master device constrained to a console, which necessarily imposes a finite ability to move the master device, is shown for example in document US-2020-0179068.
Otherwise, solutions have recently emerged with master devices which are not mechanically constrained to the “master controller” station of the robotic system, i.e., “mechanically ungrounded” or “mechanically unconstrained” or “hand-held” devices, i.e., devices of the type as shown for example in documents WO-2019-020407, WO-2019-020408, WO-2019-020409 on behalf of the same Applicant, as well as of the type as shown for example in document U.S. Pat. No. 8,521,331.
In such solutions, the problem of how to ensure teleoperation initiation procedures, and in particular of alignment between master device and slave device, remains unsolved, in the absence of a mechanical constraint with a master console and of an enslavement ensured by the motors of such a console.
Therefore, in the technical field considered, there is a strong need to effectively perform master-slave alignment procedures and checks on teleoperation initiation, which is not easy (in the absence of mechanical constraint with the master console) and, on the other hand, is absolutely necessary, and must be carried out so as to meet the very stringent safety requirements which are imposed in the field of teleoperated surgery or microsurgery by means of robotic systems, and requirement of being easy-to-use, requirements which are considered very important by each surgeon.
It is the object of the present invention to provide a method for initiating a teleoperation carried out by means of a robotic system for medical or surgical teleoperation, which allows at least partially overcoming the drawbacks claimed above with reference to the prior art, and responding to the aforementioned needs particularly felt in the technical field considered. Such an object is achieved by a method according to claim 1.
Further embodiments of such a method are defined in claims 2-41.
It is also an object of the present invention to provide a robotic system for medical or surgical teleoperation equipped to perform the aforesaid method of initiating/preparing a teleoperation.
Such an object is achieved by a system according to claim 42.
Further embodiments of such a system are defined by claims 43-45.
By virtue of the proposed solutions, it is possible to achieve a satisfactory level of alignment between at least one unconstrained master device and at least one enslavable surgical instrument (of a slave device), safely and reliably, without for this reason imposing a predetermined movement of the master device and/or maintaining a certain acceptable level of control and intuitiveness for the operator.
Further features and advantages of the system and method according to the invention will become apparent from the following description of preferred embodiments, given by way of indicative, non-limiting examples, with reference to the accompanying drawings, in which:
bis diagrammatically shows some steps included in a method embodiment, according to a possible operating mode;
With reference to
The robotic system further comprises teleoperation preparation first control means. For example, said teleoperation preparation first control means comprise a man-machine interface which allows the operator to communicate the intention to enter into teleoperation to the robot.
The method comprises the steps of initiating a teleoperation preparation step by operating the aforesaid teleoperation preparation first control means; then performing an alignment step between master device and slave device, in which the slave device is enabled to move so as to align the orientation of the surgical instrument to an orientation of the master device; then entering teleoperation after the aforesaid alignment step between master device and slave device has been completed.
During the preparation step and before the alignment step, the method includes carrying out one or more first checks for entering the alignment step, and enabling the start of the alignment step only if all the one or more first checks are successfully passed.
Furthermore, before entering the teleoperation step, the method includes carrying out one or more second checks for enabling the alignment step, and enabling the entry into teleoperation only if all the one or more second checks are successfully passed.
It should be noted that, by virtue of the provision of the aforesaid alignment step, in which the slave device is enabled to move to align the orientation of the surgical instrument to the orientation of the master device, it is possible to avoid entry into teleoperation if the master and slave devices are not aligned, thus avoiding having to recover an entry misalignment during the teleoperation, and at the same time enabling entry into teleoperation is intuitive because the misalignment threshold to enable the alignment step can be less stringent than the misalignment threshold which determines an exit from teleoperation.
According to a method embodiment, the alignment step comprises a sub-step of alignment without motion, in which the surgical instrument of the slave device is not enabled to move, and a sub-step of alignment with motion, in which the surgical instrument of the slave device is enabled to move.
In this case, according to an implementation option, the method includes carrying out alignment actions adapted to obtain the alignment of the slave device with respect to the master device, and further includes carrying out one or more third checks adapted to check transitions between the aforesaid sub-steps of alignment with motion and alignment without motion.
According to an implementation option, the above sub-steps of alignment with motion and without motion follow one another in cycles.
In such a case, at the end of each cycle, the method includes checking the outcome of the first checks, and remaining in the alignment step if all the first checks provide a positive result, and exiting the alignment step to return to the preparation step if at least one of the first checks does not provide a positive result; and further checking the outcome of the second checks, and entering the teleoperation step if all the second checks provide a positive result.
In accordance with various possible embodiments of the method, the aforesaid first checks comprise one or more of the following checks:
In accordance with a method embodiment, in which the master device has a degree of freedom of relative movement, the aforesaid check of correct grip of the master device comprises verifying that the degree of freedom of relative movement has exceeded a definable threshold value defined as a resting position.
According to an implementation option, the aforesaid degree of freedom of relative movement is a degree of freedom of opening/closure, and the verifying step comprises verifying that the aforesaid degree of freedom of opening/closure is slightly closed with an opening angle below an opening angle threshold.
According to another implementation option, the aforesaid degree of freedom of relative movement is a degree of freedom of linear displacement, and the verifying step comprises verifying that the linear displacement is an approaching/distancing linear displacement beyond a certain approaching/distancing threshold.
According to another implementation option, the aforesaid degree of freedom of relative movement is a degree of freedom of twist, and the verifying step comprises verifying that the twist is above a certain twist threshold.
In accordance with a method embodiment, in which the master device comprises a contact sensor, for example a capacitive sensor and/or a pressure sensor, the aforesaid check of correct grip of the master device comprises processing information detected by the contact sensor, for example so as to determine if the master device is in contact with the user.
According to a method embodiment, the aforesaid check of the acceptability of the position of the master device comprises verifying that the master device is within a predefined or predeterminable workspace region, for example a spatial region determined by a tracking system.
According to another method embodiment, the aforesaid check of acceptability of the position of the master device comprises verifying that the master device is not in a resting configuration, in which such a resting configuration corresponds for example to a position, and preferably also orientation and/or opening/closing level, of the master device in a workspace region adapted to stow the master device when not hand-held.
In accordance with a method embodiment, the aforesaid checks of the signal quality of the master device comprise verifying that the data communications between master device and system are active and functioning and are supported by electrical signals having a quality level and/or signal-to-noise ratio above respective predefined thresholds.
According to an implementation option, the aforesaid checks of the signal quality of the master device comprise verifying that the sensors of the master device are connected and active.
In accordance with a method embodiment, the aforesaid check of structural integrity of the master device comprises verifying one or more predefined constraints, indicative of the structural integrity of the master device, in which such constraints are verifiable based on detections/measurements of the position and/or velocity and/or acceleration of the master device.
According to an implementation option, the aforesaid structural integrity check of the master device comprises verifying that the master device defines a detected orientation corresponding to an expected orientation.
In accordance with various possible embodiments of the method, the aforesaid second checks comprise one or more of the following checks: check of alignment congruence between the orientations of the master device and the slave device, and/or check of congruence of the opening/closing levels of the master device and the slave device.
According to an embodiment, the aforesaid second checks comprise the check of the congruence of both the alignment and the opening/closing levels between the master and slave devices.
According to an implementation option, the aforesaid check of alignment congruence comprises verifying that the master device orientation and the slave device orientation are equal within a predefined tolerance represented by an allowed maximum orientation difference threshold between the orientations of the master and slave devices. In other words, such a check of alignment congruence comprises verifying that the difference between the orientations of the master and slave devices is below the aforesaid maximum orientation difference threshold.
According to an implementation option, the aforesaid check of congruence of the opening/closing levels comprises verifying that the grip closure or opening angle of the master device and the grip closure or opening angle of the slave device are equal within a predefined tolerance represented by an allowed maximum grip closure difference threshold between the opening/closing levels of the master and slave devices. In other words, such a check of alignment congruence comprises, in this case, verifying that the difference between the grip closures or opening angles of the master and slave devices is below said threshold of maximum difference between the opening/closing levels.
In accordance with various possible embodiments of the method, the aforesaid third checks comprise one or more of the following checks: check of the reachability of the master device orientation by the slave device orientation, and/or check of alignment congruence of the slave device orientation with respect to the master device orientation.
According to an implementation option, passing all the prescribed third checks allows a transition towards the sub-step of alignment with motion, while failing to pass at least one of the third checks does not allow the transition to the sub-step of alignment with motion, when in the sub-step of alignment without motion, or it forces the transition back to the sub-step of alignment without motion, when in the sub-step of alignment with motion.
In accordance with an implementation option, the aforesaid check of orientation reachability comprises verifying that the initial misalignment between the master device orientation and the kinematic orientation of the surgical instrument of the slave device is less than a master-slave initial misalignment threshold value.
According to another implementation option, the aforesaid check of orientation reachability comprises verifying that a possible alignment trajectory exists.
According to an embodiment, the aforesaid alignment congruence check comprises verifying that the master device orientation and the slave device orientation are equal within a predefined tolerance represented by a maximum orientation difference threshold dV allowed between the orientations of the master and slave devices. In other words, this means verifying that the difference between the orientations of the master and slave devices f(RPYs-RPYm) is below the aforesaid maximum orientation difference threshold dV. Such a parameter dV can correspond to the parameter DELTA V mentioned below.
In accordance with a method embodiment, the alignment congruence check, carried out as part of the aforesaid second checks or as part of the aforesaid third checks, is verified for each degree of freedom of orientation of the slave device. Such a feature will be disclosed in more detail below with reference to “Euler angles”.
In accordance with another method embodiment, the alignment congruence check, carried out as part of the aforesaid second checks or as part of the aforesaid third checks, is verified as a single overall absolute value.
According to an implementation option, the aforesaid maximum orientation difference threshold dV depends on the orientation of the slave device and/or varies based on the orientation of the micro-surgical instrument of the slave device inside the workspace thereof.
According to other possible implementation options, the aforesaid maximum orientation difference threshold dV depends on other parameters.
According to an implementation option, the aforesaid maximum orientation difference threshold dV is verified by means of a decomposition into two sub-rotations, and in which a first error of the first sub-rotation and a second error of the second sub-rotation are verified, with respect to respective thresholds.
For example, in such an implementation option, a “Twist & Swing” calculation method is used, in which, having defined a main direction of the slave device and a main direction of the master device, which are both integral with the main dimensions of the related devices, the first orientation error, or swing error, is defined as the angular error between the main directions thereof, while the second error, or twist error, is defined as the angular distance between the orientations of the master and slave devices, assuming that the first error has been compensated for.
According to another implementation option, the distance between the orientations of the master and slave devices is calculated by a “Quaternion Distance” calculation method.
According to an implementation option, the distances between the orientations of the master and slave devices are calculated using a current threshold calculation method, allowing the transition to the alignment sub-step with a movement on independent axes only for the axes in which the alignment is verified within the respective threshold, or allowing the transition to the alignment sub-step with a movement of all axes only when the alignment is verified for all the axes within the respective threshold.
According to an implementation option, the aforesaid orientation alignment checks are successfully passed for an alignment of 0° or for an alignment rotated by 180° about a longitudinal axis which is definable by the body of the master device, within a misalignment range, preferably only if some of the orientation checks are successfully passed; preferably the master device body is geometrically and/or functionally symmetric with respect to a definable longitudinal axis and the slave surgical instrument body is preferably functionally symmetric with respect to a definable longitudinal axis.
Such features will be disclosed in more detail below.
According to an implementation option, the method also includes verifying that the alignment movement of the control point of the slave device exclusively performs pure rotation movements.
In accordance with a method embodiment, the aforesaid alignment actions comprise one or more actions aimed at obtaining the following behaviors:
According to an implementation option, the velocity of motion of the slave device while aligning the micro-surgical instrument to the master device is below an alignment velocity threshold.
According to another implementation option of the method, the instantaneous angular velocity of the motion alignment trajectory of the slave device is inversely proportional to the norm of the vector of the misalignment threshold value dV.
According to another implementation option of the method, the instantaneous angular velocity of the motion alignment trajectory of the slave device is directly proportional to the time of permanence in the alignment step.
According to another implementation option of the method, the tracking motion of the slave device, from an initial orientation RPYs1 to a final orientation RPYs2, corresponding to the master device orientation, follows a trajectory adapted to monotonically reduce the distance between the two orientations.
In accordance with an embodiment, the method comprises the further step of establishing a maximum permanence time for the sub-steps of alignment with motion and without motion, and of exiting one of the aforesaid sub-steps when the predetermined maximum permanence time is exceeded.
According to a method embodiment, the aforesaid teleoperation preparation first control means comprise a pedal or a button which can be pressed to initiate the alignment step and kept pressed until the alignment step is completed.
The operator can be for example a surgeon or doctor.
According to an implementation option, the method comprises the further step of verifying at each cycle that the pedal or button is kept pressed, and in which, if the pedal or button is not kept pressed, the method includes determining an exit from the alignment step.
According to another implementation option, the method comprises the further step of verifying that the control pedal is released within a timeout period, for example between 3 and 15 seconds, once the alignment step has been completed and entry in the teleoperation step has occurred successfully.
If the pedal is not released, the teleoperation is interrupted. Thus, the method envisages that the robotic system exit the teleoperation when the operator, once the alignment step is completed, keeps the control pedal, or any other teleoperation control means, pressed for a longer time than said exit time threshold (or timeout period).
In accordance with an embodiment, the method comprises the further step of providing an interface between operator and system, operatively connected to the master device, configured to allow the operator to indicate the intention of the operator to access the teleoperation step and to enter into an alignment condition, and preferably also the intention to remain in such an alignment step until the possible completion thereof.
According to an implementation option, the aforesaid interface is a master command of opening/closure or grip configured to actuate an enslaved degree of freedom of opening/closure or grip of the slave device, when in teleoperation.
According to a method embodiment, in which the aforesaid robotic system for medical or surgical teleoperation comprises two master devices, a right master device and a left master device, and two respective slave devices, a right slave device and a left slave device, the method includes that each of the slave devices performs an alignment process with motion with the respective master device independently with respect to the other slave device, with independent alignment times and with individual entry into teleoperation independent of the entry into teleoperation of the other slave device.
According to an implementation option, the start of the alignment step of the right device is simultaneous to the start of the alignment step of the left device. Thereby, it can also be recognized whether the system comprises two master devices or a single master device.
In the aforesaid cases, an implementation option of the method provides that the aforesaid first checks comprise verifying, based on a check of geometric constraints, that the right master device is gripped in the operator's right hand and that the left master device is gripped in the operator's left hand.
According to an implementation option, the aforesaid geometric constraints comprise detecting the relative positions of the left and right master devices within a workspace.
According to an implementation option, the aforesaid geometric constraints comprise verifying that the detected positions of the right and left master devices are located in the right and left half of a workspace, respectively, either relative to the measurement system or relative to a single master device.
In accordance with a method embodiment, the start of the alignment step between the slave device and the master device is subject to the further constraint that the teleoperation control means are operated and/or pressed and kept operated and/or pressed for a predefined time, in order to avoid an involuntary teleoperation start.
According to a further method embodiment, after the start of the teleoperation further checks are performed on further constraints which must be respected during the teleoperation. In such a case, the method comprises the further step of exiting the teleoperation and/or allowing the exit from teleoperation if the aforesaid further constraints are not respected.
According to an implementation option, the aforesaid constraints comprise verifying that the velocities or accelerations of the master and slave devices are below a certain respective threshold, for a predefined initial teleoperation period.
According to various possible implementation options of the method, the entry into the alignment step, the permanence in such a step and the success or failure of the entry into the teleoperation step are signaled by appropriate audio/video signals, and/or the permanence in the alignment step is identified by an intermittent sound of frequency between 0.5 and 2 Hz.
In accordance with an implementation option, the method includes that the robotic system exits teleoperation when the operator presses the control pedal again or actuates another teleoperation control means.
In accordance with an embodiment, the method operates on a robotic system for teleoperated surgery.
A robotic system for medical or surgical teleoperation adapted to be controlled by the aforesaid method for initiating and/or preparing a teleoperation is now described.
Such a system comprises at least one master device, which is hand-held, mechanically unconstrained and adapted to be moved by an operator; and at least one slave device comprising a surgical instrument adapted to be controlled by the master device, so that movements of the slave device referred to one or more of a plurality of N controllable degrees of freedom are controlled by respective movements of the master device, according to a master-slave control architecture.
The system further comprises a control unit operatively connected to both the master device and the slave device, configured to control the system so as to perform a method of initiating and/or preparing a teleoperation according to any of the embodiments disclosed in this description.
The control unit is preferably adapted to acquire information on the pose of the master device to transmit operating signals to the surgical instrument of the enslaved slave device. The control unit is preferably comprised in a console.
The robotic system preferably comprises a tracking device, for example magnetic tracking and/or optical tracking, to map the position and orientation of the unconstrained or “flying” master device, in order to check the position and orientation of the surgical instrument of the slave device.
Preferably, there is a scaling relationship between translational movements of the master device and enslaved movements of at least one identifying control point of the surgical instrument of the slave device, in other words, the translations of the check point of the slave surgical instrument are a fraction of the translations of the master (in a range from ⅓ to 1/20). As the scaling grows, the ability to reposition or accommodate the master device in the work volume thereof becomes particularly advantageous.
In accordance with an embodiment, the system is a robotic system for teleoperated microsurgery. In such a case, the aforesaid surgical instrument of the slave device is a micro-surgical instrument.
Further details of the method according to the invention, by way of non-limiting example, will be provided below.
According to an implementation option of the method, the aforesaid second checks comprise verifying that the initial misalignment between the master device orientation and the kinematic orientation of the microsurgical instrument of the slave device is less than a master-slave misalignment threshold value.
In accordance with a method embodiment, the aforesaid misalignment threshold value varies based on the orientation of the microsurgical instrument of the slave device with respect to a predefined direction of the robotic system.
Preferably, the misalignment threshold value for enabling the start of the alignment step depends on the current pose and/or the desired pose of the surgical instrument of the slave device with respect to a predefined direction of the robotic system (for example: the longitudinal direction of a positioning spindle constrained upstream of the slave surgical instrument.
According to a method embodiment, the aforesaid second checks comprise verifying that an initial misalignment measured between the master device orientation and a predefined and known direction of the robotic system constrained to the kinematic architecture is lower than a second master-slave misalignment threshold value.
According to an implementation option, the aforesaid second misalignment threshold value is in the range between 0 and 90 degrees in absolute value.
In a further implementation option, the aforesaid second misalignment threshold value is in the range between 0 and 45 degrees in absolute value.
In accordance with an implementation option, the body of the unconstrained master device is substantially geometrically symmetrical.
The term “geometrically symmetrical” preferably means that the body of the master device is indistinguishable for an operator when rotated 180° about a definable longitudinal axis.
According to an embodiment, the term “geometrically symmetrical” means that the body of the master device is geometrically symmetrical with respect to a longitudinal axis identified by the intersection of two or more definable planes, and in accordance with such an implementation option, a local longitudinal direction of the master device is defined, given by the intersection of the aforesaid planes. In other words, according to this embodiment, the term “geometrically symmetrical” means that the master device body is geometrically symmetrical according to an “N-fold” symmetry.
According to an embodiment, the term “geometrically symmetrical” means that the body of the master device is geometrically symmetrical with respect to two orthogonal longitudinal and horizontal planes, and in accordance with such an implementation option, a local longitudinal direction of the master device is defined, given by the intersection of the aforesaid planes of symmetry.
Preferably, the surgical instrument of the slave device is functionally symmetrical. The term “functionally symmetrical” means that the surgical instrument of the slave device does not lose any functionality if it is used rotated by 180° about a defined longitudinal axis (for example the “roll” or “twist” axis passing through a shaft of the slave device), even if from a geometric point of view it may not be symmetrical.
According to an implementation option, the surgical instrument of the slave device is geometrically symmetrical as well.
In accordance with an embodiment, the term “functionally symmetrical” means that the body of the slave surgical instrument is symmetrical with respect to the local longitudinal and horizontal planes thereof, allowing the definition of a slave longitudinal direction.
During the teleoperation step, a pure rotation of the master device, with respect to the longitudinal axis thereof, commands a pure rotation having the same amplitude to the slave device with respect to the longitudinal axis thereof.
According to an embodiment in which there is a symmetry of the master device, the master device allows to be handheld indistinguishably by the operator in two symmetrical positions offset by 180° with respect to the longitudinal axis thereof previously mentioned.
As those skilled in the art will appreciate, such a property of indistinguishability of the grasp of the master device associates two possible target orientations for the slave device with each orientation of the master device, offset from each other by 180° with respect to the longitudinal symmetry axis of the master device. Preferably, only one of the two target orientations is used for tracking by the slave device during the teleoperation.
In accordance with an embodiment, such a choice is made based on the mutual orientation between the master device and the surgical instrument of the slave device and/or other contingent and specific operating conditions, before and/or during the alignment step.
In accordance with a different implementation option, such a property of indistinguishability of the grasp of the master device is also obtained in the case of a non-perfect longitudinal symmetry of the master device, and/or the slave device and/or both.
Another method for initiating and/or preparing and/or conducting a teleoperation performed by a robotic system for medical or surgical teleoperation, according to another aspect of the present invention, is now described.
The aforesaid robotic system comprises at least one master device, which is hand-held, mechanically unconstrained and adapted to be moved by an operator, and at least one slave device comprising a surgical instrument adapted to be controlled by the master device. The master device is functionally symmetrical with respect to a predeterminable single longitudinal axis (X) of the master device.
The method comprises the steps of detecting a local reference frame (MF) of the master device and the longitudinal axis (X) thereof, with respect to a main reference frame (MFO) of the master device workspace; then, defining a plurality of local reference frames which are functionally equivalent to the detected local reference frame, in which such local reference frames are rotated by a respective angle about said longitudinal axis (X) of the master device.
Subsequently, the method includes mapping a corresponding target reference frame in a workspace of the slave device for each of the aforesaid local reference frames of the master device of the aforesaid plurality of local reference frames, functionally equivalent to the local reference frame detected.
Finally, the method comprises the step of selecting an operating reference frame, among the aforesaid plurality of local reference frames functionally equivalent to the local reference frame detected, according to criteria for optimization of the trajectory of the slave device.
According to a method embodiment, the step of detecting further comprises detecting an orientation MF of the longitudinal axis X of the master device; the step of mapping further comprises mapping a corresponding target orientation MFS, in the workspace of the slave device; the step of selecting further comprises selecting an operating reference frame such that the associated target pose is optimal, to converge to said corresponding target orientation MFS.
According to an implementation option, the plurality of local reference frames comprises local reference frames integral with the master device.
According to an implementation option, the plurality of local reference frames comprises local reference frames having a component parallel to the longitudinal axis X.
In accordance with a method embodiment, the detecting step comprises detecting also the pose of the master device, wherein the pose comprises position and orientation information.
According to an embodiment, the method is performed in a generic step of alignment between master device and slave device.
According to an embodiment, the method is performed in a condition in which the surgical instrument of the slave device is not yet aligned with the master device.
In accordance with an embodiment, the method is performed during a step of alignment, with motion or without motion, between the master device and the slave device, under a condition in which the surgical instrument of the slave device is not yet aligned with the master device, and in which the slave device is enabled to move so as to align the orientation of the surgical instrument to an orientation of the master device.
In such a case, the method further comprises the steps of: performing one or more alignment checks, based on the orientations of the master and slave devices, as mapped in the workspace of the slave device; then, expressing the orientation of the master device with respect to the selected aforesaid operating reference frame; then, mapping the aforesaid orientation of the master device, expressed with respect to the selected operating reference frame, to the corresponding target orientation in the workspace of the slave device, i.e., establishing a bi-univocal association between the orientation of the master device and the target orientation of the surgical instrument of the slave device; finally, performing the alignment between the slave device and the master device based on the aforesaid target orientation of the slave device, obtained by mapping the orientation of the master device expressed with respect to the selected operating reference frame.
In accordance with a method embodiment, the rotation angle between the different local reference frames are the same, i.e., N local reference frames are provided, rotated therebetween by an angle equal to 2π/N.
According to an implementation option, the method includes two local reference frames, a first local reference frame (MF-ID) which is integral with the master device and a second local reference frame (MF-FLIP) which is integral with the master device and rotated by 180° with respect to the first local reference frame about the aforesaid longitudinal axis X of the master device. In such a case, the number N of local reference frames is equal to 2.
According to an implementation option, the aforesaid step of defining a first local reference frame (MF-ID) and a second local reference frame (MF-FLIP) comprises: defining the first local reference frame based on the detected orientation of the master device, and associating therewith an identity transformation function ID; defining the second local reference frame by applying to the first local reference frame a rotation transformation function FLIP expressed by a rotation matrix of 180° with respect to the longitudinal axis X.
In such a case, the aforesaid step of selecting an operating reference frame comprises selecting a function to be applied to the reference frame, among the aforesaid identity function ID and rotation function FLIP.
In accordance with a method embodiment, the master device has an axial symmetry with respect to the aforesaid longitudinal axis X, and the robotic system does not require alignment with respect to the longitudinal axis X, and thus enables the entry into a teleoperation step and/or operates in the teleoperation step for any rotation of the master device about the longitudinal axis X.
According to a method embodiment, the master device is geometrically symmetrical with respect to the aforesaid longitudinal axis X.
According to a method embodiment, the slave device (and in particular the control point of the slave device) is movable with respect to an axis of the slave device. Such a slave device axis is in relation with the aforesaid longitudinal axis of the master device X according to a predefined correlation.
According to a method embodiment, the slave device (and in particular the surgical instrument of the slave device) is geometrically and/or functionally symmetrical, with respect to the aforesaid axis of the slave device.
In accordance with an embodiment, during the teleoperation step, in the presence of a rotation movement about the longitudinal axis X, due to the manipulation by the operator, which occurs in a short time, below a predetermined time threshold, the method comprises switching the operating reference frame, from one to the other of the aforesaid local operating reference frames.
According to another embodiment, still referred to the case in which, during the teleoperation step, in the presence of a rotation movement about the longitudinal axis X, due to the manipulation by the operator, which occurs in a short time, below a predetermined time threshold, the method provides decoupling the enslaved movements of the slave, with reference only to the movements enslaved to those movements controlled by the longitudinal axis X of the master, until the rolling velocity of the master falls below the aforesaid time threshold.
According to an embodiment, during a phase of limited teleoperation and/or a phase of suspended teleoperation, in which the slave device is enslaved to the master device only for some of the controllable degrees of freedom, the method comprises re-evaluating which of the plurality of local operating reference frames to use for the calculation of the target orientation of the master device, in the presence of a rotation movement about the longitudinal axis X, due to the manipulation by the operator, which occurs in a short time, below a predetermined time threshold.
According to an implementation option of the method, the aforesaid rotation movement about the longitudinal axis (X), due to the manipulation by the operator, corresponds to a 180° rotation.
According to an embodiment, the aforesaid step of selecting an operating reference frame is performed based on one or more predefined selection criteria, based on the results of the alignment checks.
According to various possible implementation options of such an embodiment, the aforesaid one or more selection criteria are based on values of absolute and/or mutual orientation of the master and slave devices and/or of orientation difference between the master device and the slave device, and/or further comprise verifying other conditions based on the internal and/or external state of the robotic system and/or comprise criteria related to patient safety.
In accordance with a method embodiment, in which the slave device comprises joints adapted to allow rotations and/or movements with respect to one or more degrees of freedom, the aforesaid one or more selection criteria comprise:
According to an implementation option, the aforesaid step of selecting comprises selecting the local reference frame which minimizes a weighted function of the distance between the orientations and/or positions of the joints of the slave device and the target orientation of the master device, mapped in the workspace of the slave device.
It should be noted that the target pose and/or target reference frame in the slave space has predefined associated positions and/or orientations of the slave joints.
Optionally, such an association is a unique association.
Optionally, the aforesaid joints are only rotating.
According to a method embodiment, the aforesaid one or more selection criteria comprise selecting the local reference frame which determines a resulting pose and/or orientation of the master device, mapped in the workspace of the slave device, such as to minimize the axis-angle error with respect to the reference frame associated with the slave device in the workspace of the slave device.
According to another method embodiment, the aforesaid one or more selection criteria comprise selecting the local reference frame which determines a resulting pose and/or orientation of the master device, mapped in the workspace of the slave device, such as to maximize the distance from the predefined limits of the workspace of the slave device.
According to a method embodiment, the aforesaid one or more selection criteria comprise selecting the local reference frame which determines a resulting pose and/or orientation of the master device, mapped in the workspace of the slave device, such that the trajectory necessary for the slave device to converge towards the aforesaid resulting pose and/or orientation of the master device is the shortest in terms of angular distance traveled and/or necessary alignment time and/or optimizes criteria related to patient safety.
According to an implementation option, the aforesaid trajectory necessary for the slave device to converge towards the resulting pose and/or orientation of the master device takes into account any obstructions and/or critical areas close to the slave device.
In accordance with a method embodiment, the alignment step includes a plurality of control cycles, and the step of selecting the local reference frame is carried out at each of the aforesaid control cycles of the alignment step, or is carried out only at the beginning of the alignment step.
According to another method embodiment, the alignment step comprises a sub-step of alignment without motion, in which the surgical instrument of the slave device is not enabled to move, and a sub-step of alignment with motion, in which the surgical instrument of the slave device is enabled to move, and the step of selecting the local reference frame is carried out only during the sub-step of alignment without motion.
In accordance with a method embodiment, after the conclusion of the alignment step, the teleoperation step is conducted by expressing the current orientation of the target device, and thus the enslaved orientation of the slave device, based on the operating reference frame selected during the alignment step.
According to another implementation option, the last transformation function selected during the alignment step is used during the entire duration of the subsequent teleoperation.
According to an implementation option, the aforesaid predeterminable longitudinal axis X is an axis defined by the intersection of two symmetry planes of the master device orthogonal to each other.
According to another implementation option, the aforesaid axis of functional symmetry of the slave device is also a geometric axis of symmetry of the slave device, i.e., a symmetrical axis with respect to two slave planes of symmetry.
In accordance with a method embodiment, the step of alignment with motion comprises limiting the movement velocity of the slave device while aligning the microsurgical instrument to the master device, for example so that the movement of the slave can be understood by the operator and safe.
In accordance with a method embodiment, the alignment step provides that the slave device exclusively performs rotation movements with respect to a portion of the slave device itself.
According to an implementation option, the aforesaid portion of the slave device, which is to be verified for rotational movements, is to be understood as the tip of the slave device.
According to an implementation option, the aforesaid checks are performed on a virtual point of action of the micro-surgical instrument, for example the midpoint between the controlled ends of the slave device.
According to an implementation option, other portions of the slave device, other than the tip and articulated thereto (belonging to the upstream positioning and orientation kinematic chain), can translate, and thus are not subject to the aforesaid verification of exclusive rotational movement.
As already noted, in an embodiment, the master device has a degree of freedom of relative movement called opening/closure. According to an implementation option, such a degree of freedom of opening/closure is associated with the deformation level of the master device or a part thereof. According to another implementation option, such a degree of freedom is associated with the amount of force and/or torque induced by the operator on the master device or a part thereof.
In such a case, according to an implementation option, the aforesaid checks comprise verifying that the opening angle is lower than a certain threshold.
According to an implementation option, the aforesaid opening angle threshold is in the range between 10 and 45 degrees between the rigid parts of the master device, or is a deviation threshold in the range between 5 and 15 degrees with respect to the starting opening angle i.e., resting angle.
According to an embodiment, the aforesaid degree of freedom of opening/closure is identified by a deformation/translation of the master, or by the distance of two points integral with the structure of the master itself.
In an embodiment, the points which determine the degree of opening/closure thereof are the tips of the master device. In such a case, the aforesaid linear opening threshold is in the range between 3 and 20 mm and preferably between 3 and 10 mm.
According to an embodiment, the master device has a sensor set adapted to measure the amount of force or torque applied by the operator on the master or in some parts thereof.
In such a case, the aforesaid first checks comprise verifying that the magnitude of the physical quantities measured on the master or in some parts thereof suggest that such a master device is actually handled by an operator.
In a method embodiment, the aforesaid interface between operator and system consists of the position of the unconstrained master device within a work area.
According to an implementation option, a set of poses of the master device are excluded from such a work area, in which such a device is recognized to be in a resting or stowed condition, or stored in a volume adapted to house the master when not handled.
According to an implementation option, such a resting condition is identified by the presence of the master device in a given spatial region as well as by an orientation and/or an opening/closing level of the master device denoting the stowing thereof. In an embodiment, such a resting condition is uniquely identified by the position of the master device in a given spatial region.
It should be noted that, during the alignment step, the enslavement strategy between master and slave is articulated so as to maximize compliance with the safety constraints related to the patient's anatomy and not necessarily minimizing the movement of the slave device. In an implementation option, the slave device may not follow the shortest angular trajectory during alignment.
According to an embodiment, the method includes that the robotic system exits the alignment step if such a step exceeds a time greater than an alignment time threshold between 2 and 15 seconds, for example.
By way of non-limiting example, further details of a preferred method embodiment, comprising a wide variety of checks and verifications, including those already mentioned above, are given below.
The reference frames mentioned below are shown in
In general terms, without considering the degree of freedom of opening/closure (“grip”) of the master device and the enslaved surgical instrument of the slave device:
Therefore, given a fixed reference system (FRS), a “master to slave transformation” (MST) is defined as the transformation which maps MFO-related transformations into SFO-related transformations, and thus the application of MST to the transformation from MF to MFO is defined as “master frame in slave workspace” (MFS).
When the system is in remote operation, the robotic system actuates the slave device so that the “slave frame” SF thereof tracks the “master frame in slave reference system” MFS controlled by the user (apart from translational scale and offset factors).
Therefore, from the rotational point of view, according to an embodiment, the master and slave devices being perfectly symmetrical with respect to a longitudinal plane thereof, it is indifferent that “slave frame” SF tracks “master frame in slave workspace” MFS calculated as described above or deriving from a pre-rotation of “master frame” MF by 180° around the main dimension of the master device (for example the longitudinal extension of the master device body mechanically unconstrained to the console).
In this context, once the possibility of the robotic system and the intention of the operator to start a teleoperation has been verified, the robotic system performs a preliminary step adapted to:
Further details of a preferred method embodiment are shown below, comprising a wide plurality of checks and verifications, comprising those already mentioned, and in which the surgeon controls the transitions between the preparation, start and performance steps of the teleoperation through a control pedal.
When the surgeon sits at the master console, the robotic system (hereinafter also referred to as “robot”) is not yet in teleoperation.
At this point, the surgeon presses the control pedal and holds it down until the alignment step is complete. According to a preferred implementation option, where the control pedal is released prior to the completion of the alignment step, the robot terminates the alignment step without starting the teleoperation step.
Once the operator's action on the control pedal has been detected, the robot is configured to immediately operate the following checks 1), 2), 3), 4).
Upon passing said verification 1), the robot provides a confirmation signal (for example, green light and acoustic signal).
Preferably subsequently, but also simultaneously, the robot proceeds with the following checks:
This can be performed for example by means of a master device tracking sub-system, comprised in the robotic system. For example, the robotic system can be provided with a tracking magnetic field generator, integral with the master console.
According to an implementation option, the robotic system is provided with an optical tracking system. For example, the optical tracking system comprises a stereoscopic system of cameras and is capable of uniquely identifying the pose of the master device within a predeterminable workspace.
Pressing the control pedal, the robot processes the information coming from the tracking sub-system to detect the presence, or absence, of the master device within a predeterminable work space.
This can be done for example by evaluating that two tracking sensors 134, 135 (for example: magnetometer type sensors and/or optical marker) associable with the master device lie in a plane, by comparing the model of the master device with the current pose of the tracking sensors. For example, such a comparison can indicate that the rods, or arms, of the master device body are or are not deformed. Examples of other integrity checks can be based on measurements of the position and orientation of the rods or arms of the master device.
This can be done by the surgeon by pressing the rods of the master device towards closure. In such a case, the surgeon's intention to enter into teleoperation is detected by verifying that the opening angle of the rods or arms is less than a predeterminable quantity (DeltaM), for example a fraction of the maximum opening and/or the initial opening of the master device arms, thereby detecting the tracking sensors 134, 135 approaching each other.
According to an implementation option, a slight closure of the degree of freedom of opening/closure of the master device corresponds to the quantity capable of detecting the intention to enter into teleoperation.
Alternatively, this can be done by assessing the presence of the master devices in an area other than the resting area in which the master is stored.
It should be noted that, if the aforesaid checks 1) and then 2), 3), 4)—which preferably occur in real time, i.e., in a fraction of a second—give a positive result, the robot does not yet enter a teleoperation step, but starts an alignment step in which the slave device is enabled to move (which can be signaled by a respective acoustic or visual signal).
If even one of the aforesaid checks fails, then the robot emits an anomaly warning signal (acoustic and/or video), and it is necessary to release the pedal and then press it again to retry, in other words starting over from the step of providing the intention to enter into teleoperation.
In an embodiment, the user receives acoustic, video or vibration communication from the master devices about the entry into the alignment step as well as about the entry into complete teleoperation.
In an embodiment, the user receives information regarding the actions to be taken to pass said first checks after pressing the pedal, such as: keeping the master device in the work area, exercising teleoperation intention by means of closing, moving the master device in an orientation direction to exceed the control threshold.
In the alignment step, there is a mismatch between the movement of the master device, held by the surgeon and which could also temporarily remain stationary, and that of the slave device: in fact, the slave device must recover the misalignment with respect to the master device. In other words, one of the objectives of the alignment step is to make sure that the surgical instrument of the slave device recovers any orientation errors with respect to the master device before proceeding with the teleoperation.
In this step, the movement of the surgical instrument of the slave device is still “intuitive” for the operator, as it respects an appropriate tracking strategy and reacting in a predictable manner to the further movements of the unconstrained master device hand-held by the operator, although not necessarily faithfully reproducing, scaled, the movement of the master device. It should be noted that the tips of the surgical instrument of the slave device could be near the patient in this step, and thus large uncontrolled movements of the slave device must be absolutely avoided. For this reason, during the alignment step, the control point which identifies the slave surgical instrument can only perform purely rotational movements, and never translating. In other words, by providing that the surgical instrument of the slave device performs only rotations, to achieve alignment, without moving in translation, large uncontrolled movements on the slave side are avoided.
In order to minimize the movement of the slave device during the alignment step, said alignment step can be seen as articulated in two sub-steps: A) alignment without slave motion and B) alignment with slave motion, as explained in more detail below. The transition between the two sub-steps can be continuously evaluated by the robot and can occur in both directions, even repeatedly. Overall, the alignment step ends either with the entry into a master-slave teleoperation state or with failure.
As previously stated, the master device can be geometrically and/or functionally symmetrical and the surgical instrument of the slave device can have at least a functional symmetry.
According to a preferred implementation option, both the master device and the slave surgical instrument are horizontally and longitudinally symmetrical, i.e., for each of the master and slave devices a longitudinal direction (axis of symmetry) given by the intersection of the relative two symmetry planes (biplanar symmetry) is definable.
When the master device is symmetrical, two symmetrical configurations of the master device with respect to the longitudinal axis are indistinguishable by the operator and are functionally and geometrically equivalent. According to such an implementation option, two symmetrical configurations of the slave device with respect to the longitudinal direction thereof are functionally equivalent, and preferably also geometrically equivalent and indistinguishable.
According to such an implementation option, the robotic system pre-processes the spatial orientation of the master device before being transposed into the slave space as a “master frame in slave workspace” MFS. The pre-processing can comprise applying one of the two possible transformation functions to the master pose MF which exploit the properties of symmetry between the master and slave devices, i.e.:
Based on the mutual and/or absolute orientation of the master and slave devices and/or other conditions based on the internal and/or external state of the robotic system, the robotic system selects among the “identity” and “flip” functions the one to use for the calculation of the target orientation to be used for tracking. The selection is made in accordance with one or more of the criteria described below.
According to an implementation option, such a trajectory could take into account any encumbrance and/or critical areas near the slave device.
According to an implementation option, the robotic system selects the transformation function which best meets one or more selection criteria at each control cycle of the alignment step. According to such an implementation option, the last transformation function selected during the alignment step will be used during the entire duration of the next teleoperation.
According to a different implementation, the selection of the transformation function used occurs only in the initial moments of the alignment step.
According to a different implementation, the selection of the transformation function used is performed only during the alignment step without motion.
According to an implementation option which provides the symmetry of each of the master devices (geometric symmetry) and slave surgical instrument (at least functional symmetry which can also be geometric) with respect to a respective definable longitudinal axis, or a respective definable at least one longitudinal plane, the robot evaluates the spatial orientation of the master device in the slave space (“master frame in slave workspace” MFS) in two possible configurations, i.e., (i) the configuration obtained directly from the pose of the master device, and (ii) the configuration obtained rotating (“flipping”) the master device body by 180° about the longitudinal extension direction thereof. The robot then selects the configuration which meets one or more of the following requirements (hereinafter referred to as “MASTERMAP”).
Regardless of the sub-step of the alignment step in progress, at any moment the robot uses the “master frame in slave workspace” MFS which best meets the selection criterion adopted. The “master frame in slave workspace” MFS used in teleoperation will be the last “master frame in slave workspace” MFS selected during the alignment step.
According to a different implementation, the “master frame in slave workspace” MFS is fixed using one of the criteria listed above as soon as the alignment step begins.
According to a different implementation, the “master frame in slave workspace” MFS is fixed using one of the criteria listed above only in a sub-step of the alignment step in which the slave device is not in motion.
The two sub-steps A, B which describe the alignment process are described in more detail below.
The first alignment sub-step A is an “alignment without slave motion” step. Such a sub-step A does not provide any motion of the slave device and does not complete the master-slave alignment.
In this sub-step A, the robot performs further checks, including the following ones.
It should be noted that the tip or spout 142, 143 of the surgical instrument of the slave device identified by the “slave frame SF triple” with respect to a “slave frame origin” SFO reference frame refers to a control point belonging to the slave surgical instrument or a virtual point rigidly associated with the slave surgical instrument. The control point must move in this step only for pure rotations, avoiding any translations. This helps to avoid potential catastrophic risks for the patient.
According to various implementation options, the control performed by the software of the robot can be performed by taking the aforesaid tips as the control point(s), or virtual points which do not coincide with the free end of the tip, but are, for example, at or around the point of the spout or tip intended to grip the surgical needle with contact.
According to various implementation options, the calculation of the value of DELTA V can be obtained using the following calculation methods.
|MEUL i−SEUL i|<DELTA V
for each element i of the vector.
For the extraction of the Euler angles, it is possible to use the RPY convention (“roll-pitch-yaw”) or any of the other 11 sequences of non-consecutive equal axes contemplated by the already known method of representing Euler angles. A possible choice for DELTAV is between 5° and 15°.
|EA|<DELTA V.
A value of DELTAV between 5° and 15° can be selected.
|vect(RT,RS) i|<DELTA V i
for both elements i of the vector. The first component can have a greater margin (e.g., from 5° to 30°) while the second a smaller margin (e.g., from 5° to 15°).
According to different implementation options, the quantity DELTA V can be arbitrarily selected large enough to make the condition A2 always true for any “slave frame” SF and “master frame in slave workspace” MFS pair.
According to different implementation options, the quantity DELTA V can be fixed or variable depending on the “slave frame” SF, “master frame in slave workspace” MFS, the selected scale factor (“scaling”) or on combinations of these and other internal states of the software of the robotic system.
If the checks A1 and A2 are positively passed, the robot enters the second alignment sub-step, i.e., the “alignment with slave motion” sub-step B.
During such a sub-step, the slave device moves to reach the orientation of the master device. In other words, “slave frame” SF moves to reach “master frame in slave workspace” MFS.
During sub-step B:
Preferably, also during this sub-step B, the aforesaid checks 2), 3), 4) on the master device, previously described, are performed continuously, and the robot exits the alignment step and/or the sub-step B of alignment with motion, when at least one of such checks on the master 2), 3), 4) fails.
According to an implementation option, the robot exits the alignment with motion sub-step B and returns to the alignment without motion sub-step A.
During the alignment with motion sub-step B, the trajectory performed by the slave device respects one or more of the following control strategies:
B5) the instantaneous angular velocity threshold of the alignment trajectory is inversely proportional to the norm of the vector DELTA V calculated by means of any of the previously mentioned methods, in other words it increases while the master-slave misalignment angle decreases.
The alignment trajectory is appropriately constructed to meet one or more of the following requirements:
During the alignment with motion sub-step B, the closure (grip) of the slave surgical instrument converges with that of the master device with a trajectory meeting one or more requirements B1, B2, B3, B4, B5, B6, B7, B8. During the alignment with motion sub-step B, the conditions A1 and A2 are continuously checked in real time, at periods of the order of small fractions of a second.
If at least one of the aforesaid checks A1-A2 is not passed, then the robot returns to the alignment without motion sub-step A of the slave waiting for both checks A1-A2 to be positive.
If all the aforesaid A1-A2 checks instead give a positive result, then the robot remains in sub-step B until the alignment step is completed.
It should be noted that, also during this sub-step B, the aforesaid checks 2), 3), 4) on the master device, previously described, are performed continuously, and the robot exits the alignment with motion sub-step B, returning to the alignment without motion sub-step A. In this case, it will be possible to return to sub-step B only when the conditions 2) 3) and 4) are also met.
The alignment step is completed when, during sub-step B, the following conditions occur:
If the above conditions COND-TELEOP 1 and COND-TELEOP 2 are not reached within a time Timeout A, the robotic system immediately terminates the alignment step, and it will be necessary to release the control pedal before starting a new alignment step.
According to a preferred implementation option, in the transition between the alignment step and the teleoperation step it is determined which of the two possible opposite “master frame in slave workspace” MFS configurations will be used in the remainder of the teleoperation. In addition, the translation offsets of “master frame in slave workspace” MFS are preferably defined such as to allow, at the very first instant of entry into teleoperation, to obtain a relative position of the master device coinciding with the origin of “slave frame” SF with respect to the reference frame “slave frame origin” SFO.
According to a further implementation option, upon the loss of one or more of the above conditions, it follows that the robot exits the alignment with motion sub-step B and returns to the alignment without motion sub-step A. In this case, it will be possible to return to sub-step B only when also the conditions 2) 3) and 4) are met again.
The teleoperation step provides that in a first phase of limited duration the movements are limited in terms of velocity and/or acceleration, so as to avoid movement jerks of the slave device during the transition from the alignment step to the teleoperation step.
According to an implementation option, once the robot enters the teleoperation step, the control pedal must be released within a certain timeout T, for example between 3 and 20 s. If the pedal is not released within such a time, the robotic system exits the teleoperation state, and it will be necessary to release the pedal and restart the alignment sequence.
What is described above refers to the case in which there is only one master device and only one slave device.
In a preferred system embodiment, in which there are two master devices and two slave devices, the control strategy is structured as follows:
Consequently:
In this case, if the alignment cannot be reached, teleoperation with a single master-slave pair is not allowed, and the operator must return to the beginning of the entire procedure, i.e., must release the pedal and then press it again.
In a preferred system embodiment, the control strategy is structured as follows:
Consequently:
In this case, if alignment cannot be achieved, teleoperation with a single master-slave pair is not allowed.
If the predefined time is exhausted, the alignment process will fail for both master-slave pairs and the operator must release the pedal before restarting a new teleoperation entry attempt.
According to different implementation options, (COND1) can be relaxed, allowing both master-slave pairs to enter the alignment step in a temporally deferred manner (as long as the “advance” pair is still in the alignment step and has not already entered the teleoperation step)
According to different implementation options, (COND2) can be relaxed, allowing one master-slave pair to enter into teleoperation while the other is still in the alignment step. In this case, the slave device which enters into teleoperation can move only by rotation or have a limited possibility of translation.
According to an embodiment, each master device is uniquely assigned to a respective slave device, whereby the right master device must be on the right and control the right slave. In this context, in the case of two master-slave pairs, there is an additional necessary condition for the start of the alignment step, which is condition 5) “right-left exchange”: in the case of several master-slave pairs, the position of the frame related to the right master in the reference frame “MFO” must be “on the right” with respect to the frame related to the left master. The evaluation of “right” and “left” is done by projecting the coordinates of the master frames along a direction in MFO coinciding with the natural concept of right and left from the operator's point of view. If the masters are “exchanged”, when the control pedal is pressed, it is not possible to start the alignment step but the operator is notified, by a message on the screen, to exchange the masters.
According to different implementation options, the condition 5) can be relaxed or extended to the entire alignment step. In the latter case, meeting condition 5) will be added to conditions A1 and A2 for the persistence of the master-slave pair in the alignment with motion sub-step B.
It should be noted that the parameters DELTA V, DELTA U as well as the construction strategies of the trajectories during the alignment step of the two master-slave pairs are in general independent of each other, and may depend on the state of the robotic system as well as the type of surgical instrument engaged.
In an embodiment, DELTA V is greater than Delta U, i.e., the acceptable misalignment threshold is greater in alignment without motion sub-step A with respect to when in the alignment with motion sub-step B. For example: the set of three DELTA V is calculated with a Euler angle method with a value in the range 10°-90°/10°-60°/10°-85° and Delta U is a value calculated with a “Quaternion distance” method in the range 0°-10°.
According to different implementation options, DELTA V, Delta U of the master-slave pairs can depend on the current state of the alignment procedure. For example, the convergence of one of the pairs or the time elapsed since the start of the alignment step can widen the tolerance margins DELTA V and Delta U so as to increase the usability of the robotic system.
In summary, the implementation option disclosed in detail above can be summarized as follows:
If all the above-mentioned checks are passed positively, the robotic system provides the user with an audio and/or video confirmation signal.
The alignment step is entered, and in particular a sub-step of “alignment without slave motion”. According to an implementation option, in the event of two master devices, each master-slave pair enters sub-step A of the alignment step independently of the other. In said sub-step A:
If the above occurs, a sub-step B of “alignment with motion” of the slave is entered, in which the slave device is moved to reach the master device, and in particular the orientation and the degree of opening/closure controlled by the respective master device. If one of the conditions A1 or A2 is missed, the robotic device returns to sub-step A of the alignment step.
During the alignment sub-step B, the slave device moves only by rotations with trajectories which respect control dynamics as described above.
When there is symmetry of the bodies of the master and slave devices with respect to the respective longitudinal axis/plane, it is possible to control the slave device both with the “master frame in slave workspace” MFS and with the version thereof rotated by 180° with respect to the main dimension, i.e., the longitudinal extension, of the master device. For this reason, in both sub-steps, it can be continuously decided which of the two versions of “master frame in slave workspace” MFS to use based on certain optimization criteria described above.
If during any of the sub-steps, one of the conditions from CHECK2-CHECK4 fails, the robotic system immediately interrupts the alignment step. Other implementation options already described in the document relax this condition.
If after a predefined time the robotic system is still in the alignment step, the alignment step ends without entering into teleoperation. Otherwise, if within a predefined time all the master-slave pairs which have begun the alignment have actually aligned therein (except for said error Delta U), the robotic system enters into teleoperation.
Entering teleoperation, for each of the master-slave pairs, the used version of “master frame in slave workspace” MFS is frozen and the translational offsets between the master space and the slave space are defined.
According to an implementation option, at the beginning of the teleoperation step, slave accelerations and velocities are limited for a certain initial finite time period.
Once in teleoperation, the control pedal must be released within a certain time, under penalty of forced interruption of the teleoperation. The operator is able to distinguish the presence in the alignment step and the transition to the teleoperation step by means of a change of audio and video interface. According to an implementation option, the robot emits an intermittent sound during the alignment step. Such a sound is concluded with several other sounds, distinguishable from each other, if the entry into teleoperation has been successful or if the alignment step has failed.
In the example shown in
In the example in
In the example shown in
The example in
In the example shown in
As described above, the master device 110 does not necessarily comprise two rigid parts constrained in a rotational joint to rotate about a common axis to control an enslaved degree of opening/closure or grip G, and for example the master device can comprise two rigid parts constrained to translate with respect to each other along a common axis and/or a button and/or a sensorized interface for example comprising a presence or contact sensor to control an enslaved degree of freedom of opening/closure or grip G.
The example shown in
As can be seen, the objects of the present invention as previously indicated are fully achieved by the method described above by virtue of the features disclosed above in detail.
In fact, the method and system described above make it possible to effectively perform master-slave alignment procedures and checks on teleoperation start, even for mechanically unconstrained master devices.
The procedures and checks performed before and during the alignment, and before the teleoperation, can be articulated in various manners, depending on the needs, and allow meeting a wide range of safety requirements, even very stringent, which are imposed in the field of surgery or microsurgery teleoperated by means of robotic systems.
In particular, as previously observed, by virtue of the provision of an alignment step, in which the slave device is enabled to move to align the orientation of the surgical instrument to the orientation of the master device, it is possible to avoid entry into teleoperation if master and slave are not aligned, thus avoiding having to recover an entry misalignment during the teleoperation, and, at the same time, enabling entry into teleoperation is intuitive because the misalignment threshold to enable the alignment step can be less stringent than the misalignment threshold which determines an exit from teleoperation. In other words, an aid is provided to the operator (surgeon) because during the alignment step the slave is enabled to move to align with the orientation of the master device, once the aforesaid first checks are met.
In order to meet contingent needs, those skilled in the art may make changes and adaptations to the embodiments of the method described above or can replace elements with others which are functionally equivalent, without departing from the scope of the following claims. All the features described above as belonging to a possible embodiment may be implemented irrespective of the other embodiments described.
| Number | Date | Country | Kind |
|---|---|---|---|
| 102021000003419 | Feb 2021 | IT | national |
| Filing Document | Filing Date | Country | Kind |
|---|---|---|---|
| PCT/IB2022/051226 | 2/11/2022 | WO |
