Method and device to assist with the operation of an instrument

Patent metadata

Field	Value
Publication number	US-10582977-B2
Application number	US-201615548705-A
Country	US
Kind code	B2
Filing date	Feb 5, 2016
Priority date	Feb 5, 2015
Publication date	Mar 10, 2020
Grant date	Mar 10, 2020

Abstract

The invention relates to a device and a method to assist with the operation of an instrument by means of said device, the device and the method using leverage effects in order to calculate the data relative to any point of an instrument axis, instead of using low-accuracy sensors. Other improvements are also described that allow higher-quality usage performance for the operator, which reduces the risk of errors and simplifies the operations.

First claim

The invention claimed is:

1. A method to assist with the manipulation of an instrument by means of an assistance device ( 1 ) in manipulating the instrument ( 20 ),
the device ( 1 ) comprising
a hinged arm ( 10 ) designed to be attached to a frame (B) and manipulable by an operator, to which an instrument ( 20 ) can be attached at an attachment point (P) of said hinged arm ( 10 ) forming a passive ball joint between the hinged arm ( 10 ) and the instrument ( 20 ), the hinged arm comprising motors (M 1 , M 2 , . . . ) for displacing the attachment point (P) in a reference frame (R) bound to the frame (B), the instrument ( 20 ) being manipulable around a fulcrum (F) having a known and fixed position in the reference frame (R),
a processing unit (U) comprising a processor (U 1 ) configured to control the motors (M 1 , M 2 , . . . );

the method being characterized in that it comprises the steps of:
determining (E 1 ) data relating to a position and/or a velocity of the attachment point (P) in the reference frame (R);
determining (E 2 , E 3 , E 4 ) a force ({right arrow over (F P )}) to be applied to the attachment point (P) as a function of said data relating to the attachment point, the position of the fulcrum, the known distance ( PQ ) from the attachment point (P) to an arbitrary point of an instrument axis connecting the attachment point (P) to the fulcrum (F), and a given impedance to be conferred to the arbitrary point (Q),
controlling (E 5 ) the motors (M 1 , M 2 , . . . ) to transmit the force ({right arrow over (F P )}) to the instrument ( 20 ) at the attachment point (P) so as to produce the impedance at the arbitrary point (Q).

2. The method according to claim 1 , wherein the step of determining the force (Fp) to be applied to the attachment point comprises the following steps:
determining (E 2 ) data regarding the velocity and/or the position of a point (Q) of the instrument situated on an instrument axis (X-X′) passing through the attachment point (P) and the fulcrum (F), by means of said data relating to the attachment point (P) and the position of the fulcrum (F);
determining (E 3 ) a force ({right arrow over (F Q )}) to be applied to the point Q as a function of an impedance to be conferred to the instrument ( 20 ) at said point (Q) of the instrument ( 20 ) and as a function of the data determined regarding said point (Q) of the instrument ( 20 );
determining (E 4 ) a force ({right arrow over (F P )}) to be applied to the attachment point (P) as a function of the force ({right arrow over (F Q )}) to be applied to the arbitrary point and the data relating to the attachment point P and to the position of the fulcrum (F).

3. The method according to claim 1 , wherein the impedance comprises a viscosity and the force ({right arrow over (F P )}) applied to the attachment point (P) is a resistance force in the opposite direction to its displacement.

4. The method according to claim 1 , wherein the impedance comprises a stiffness and the force ({right arrow over (F P )}) applied to the attachment point (P) is a force in the same direction or in the opposite direction to its displacement, depending on the sign of the stiffness.

5. The method according to claim 4 , wherein the position of the attachment point (P) in the reference frame (R) is determined by means of sensors (C 1 , C 2 , C 3 ) in the hinged arm ( 10 ), the hinged arm comprising three hinges (A 1 , A 2 , A 3 ) each actuated by a motor (M 1 , M 2 , M 3 ) and each comprising one of the sensors (C 1 , C 2 , C 3 ).

6. The method according to claim 1 ,
wherein the direction of the instrument axis (X-X′) is known, the method comprising a preliminary step (E 0 ) of determining the position of the fulcrum (F) in said reference frame (R), and the following sub-steps
obtaining (E 01 ), in the reference frame, a plurality of straight lines (Δ) defined by the instrument axis (X-X′), the straight lines corresponding to a plurality of positions of said instrument ( 20 ) around the fulcrum (F),
estimating (E 02 ) an intersection zone (V ol ) of said plurality of straight lines (Δ),
obtaining (E 03 ) the position of the center of said zone (V ol ), which corresponds to the fulcrum (F).

7. The method according to claim 6 , wherein the orientation of the instrument axis (X-X′) is obtained by means of two angular position sensors (C 4 , C 5 ) at the attachment point (P).

8. The method according to claim 1 , wherein the impedance comprises a viscosity, and wherein the step (E 3 ) of determining the force (Fq) at said point (Q) comprises the following sub-steps for determining the impedance to be conferred:
determining (E 1 ′) the instantaneous velocity ({right arrow over (v)}(Q)) of said point (Q) of the instrument,
determining (E 21 ′) a first viscosity as a decreasing function of said instantaneous velocity ({right arrow over (v)}(Q)),
determining (E 22 ′) a second velocity from the first viscosity thanks to a filtering method having at least one parameter allowing the dynamics of the method to be regulated;
determining (E 3 ′) the force at said point of the instrument, as a function:
of said velocity ({right arrow over (v)}(Q)), and
of the second viscosity value allowing the dynamics of the method to be adjusted.

9. The method according to claim 8 , wherein the instantaneous velocity of the point (Q) is filtered.

10. The method according to claim 1 , wherein the method comprises:
having a point of the instrument coincide (E 01 ′) with points in space and determining the position of said points in space in the reference frame bound to the assistance device;
constructing (E 03 ′) a geometric constraint defined by said points in space by means of said positions.

11. The method according to claim 10 , wherein the impedance comprises a stiffness, the method comprising a preliminary step of constructing a plane, said point of the instrument being a distal end, said step comprising the following sub-steps:
pointing (E 01 ′) with the distal end to at least three non-collinear points and determination of their position, and determination (E 02 ′) of their position in the reference frame (R),
construction (E 03 ′) of a plane (PLAN 1 ) passing through the three points by means of the three positions,
the step (E 3 ) of determining the force ({right arrow over (F P )}) at the attachment point (P) comprising the following sub-steps:
determining (E 31 ″) the distance between said point (Q) of the instrument ( 20 ) and the plane by orthogonal projection,
determining (E 32 ″) the force ({right arrow over (F Q )}) as a function of a stiffness and of said distance,
so that the step (E 5 ) of controlling the motors constrains the instrument to position itself with respect to the plane (PLAN 1 ) by causing the attraction or the repulsion of said point (Q) of the instrument axis (X-X′) with respect to said plane (PLAN 1 ).

12. The method according to claim 1 , wherein a plurality of switching modes is implemented in the processing unit (U), each mode having a predetermined impedance, the method comprising switching automatically from one control mode to another when a criterion is verified.

13. The method according to claim 12 , wherein said at least one criterion only involves the data relating to the assistance device ( 1 ).

14. The method according to claim 13 , wherein two impedances are configured to define respectively a free mode and a locked mode, wherein a locking criterion makes it possible to transition from the free mode to the locked mode and an unlocking criterion makes it possible to transition from the locked mode to the free mode.

15. Th

Assignees

• Univ Pierre Et Marie Curie Paris 6
• Centre Nat Rech Scient
• Endocontrol
• Univ Sorbonne

Inventors

• Morel Guillaume
• Dong Lin
• Richer Florian
• Perrin Nicolas
• Vidal Clément
• Bardou Bérengère

Classifications

• A61B2090/062

  penetration depth · CPC title

• A61B34/77

  Manipulators with motion or force scaling · CPC title

• A61B34/75

  Manipulators having means for prevention or compensation of hand tremors · CPC title

• A61B34/37 Primary

  Leader-follower robots (A61B34/35 takes precedence) · CPC title

• A61B2090/067

  for measuring angles · CPC title