Frame Mapping and Force Feedback Methods, Devices and Systems

• US 20110160745A1
• Filed: 04/16/2008
• Published: 06/30/2011
• Est. Priority Date: 04/16/2007
• Status: Active Grant

• Current Assignee: Deerfield Imaging Incorporated
• Original Assignee: Governors of the University of Calgary
• Inventors: Fielding, Tim, Newhook, Perry
• Granted Patent: US 8,554,368 B2
• Time in Patent Office: Days
• US Class Current: 606/130
• CPC Class Codes: A61B 2034/305 Details of wrist mechanisms at distal ends of robotic arms
• CPC Class Codes: A61B 2090/064 for measuring force, pressure or mechanical tension
• CPC Class Codes: A61B 34/30 Surgical robots
• CPC Class Codes: A61B 34/37 Master-slave robots A61B34/35 takes precedence
• CPC Class Codes: A61B 34/76 Manipulators having means for providing feel, e.g. force or tactile feedback
• CPC Class Codes: A61B 90/361 Image-producing devices, e.g. surgical cameras
• CPC Class Codes: B25J 9/1689 Teleoperation
• CPC Class Codes: G05B 2219/40137 Force sensation feedback from simulated tool
• CPC Class Codes: G05B 2219/40182 Master has different configuration than slave manipulator
• CPC Class Codes: G05B 2219/40401 Convert workspace of master to workspace of slave
• CPC Class Codes: G05B 2219/45117 Medical, radio surgery manipulator

Abstract

Methods, devices, and systems for controlling movement of a slave manipulator by an operator controlling a master manipulator in a way that the motion of that slave manipulator can be presented via a display to the operator such that the displayed position of the slave manipulator is intuitive to the operator, regardless of the actual position and orientation of the slave manipulator. Methods, devices, and systems relating to force feedback associated with medical robotic procedures.

Claims

1-104. -104. (canceled)

105. A method comprising:

a. determining a calculated motion of a tool of a medical robotic arm, where wherein;

i. the determining of the calculated motion is based on an input value received from a controller device that provides input from a user; and

ii. the calculated motion is expressed in an observer coordinate system that is based on the orientation of the tool and the orientation of an observer reference structure; and

b. outputting an actuation signal to move the medical robotic arm in accordance with the calculated motion.

106. The method of claim 105, wherein the tool is held by the robotic arm.

107. The method of claim 105, further comprising:

c. determining a calculated observer force value that is expressed in the observer coordinate system and based on a virtual force value; and

d. outputting a feedback signal to the controller device in accordance with the calculated observer force value.

108. The method of claim 105, further comprising:

e. determining a calculated observer force value that is expressed in the observer coordinate system and based on a measured force value from the medical robotic arm; and

f. outputting a feedback signal to the controller device in accordance with the calculated observer force value.

109. The method of claim 108, wherein the calculated observer force value is also based on a virtual force value.

110. The method of claim 109, wherein calculation of the virtual force value comprises using one or more calculated virtual collisions, one or more joint limits, motion divergence or a combination thereof.

117. The method of claim 109, wherein the tool has a tool axis, and the observer coordinate system comprises an axis that corresponds to the tool axis.

118. The method of claim 105, further comprising:

g. determining a second calculated motion of a second tool of a second robotic arm, where;

i. the determining of the second calculated motion is based on a second input value received from a second controller device that provides input from the user; and

ii. the second calculated motion is expressed in a second observer coordinate system that is based on the orientation of the second tool and the orientation of the observer reference structure; and

h. outputting a second actuation signal to move the second medical robotic arm in accordance with the second calculated motion.

119. The method of claim 118, further comprising:

i. determining a second calculated observer force value that is expressed in the second observer coordinate system and based on a second virtual force value; and

j. outputting a second feedback signal to the second controller device in accordance with the second calculated observer force value.

120. The method of claim 118, further comprising:

k. determining a second calculated observer force value that is expressed in the second observer coordinate system and based on a second measured force value from the second medical robotic arm; and

l. outputting a second feedback signal to the second controller device in accordance with the second calculated observer force value.

121. The method of claim 120, wherein the second calculated observer force value is also based on a second virtual force value.

122. The method of claim 121, wherein calculation of the second virtual force value comprises using one or more calculated virtual collisions, one or more joint limits, motion divergence or a combination thereof.

156. A computer readable medium comprising machine readable instructions for performing the method according to claim 105.

158. A control system for use in control of at least one medical robotic arm, the control system configured in accordance with the method according to claim 105.

111-116. -116. (canceled)

123-129. -129. (canceled)

130. A method comprising:

a. receiving an input value from a controller device representative of a desired motion of a tool of a medical robotic arm, wherein the input value is expressed in a controller device coordinate system;

b. determining a calculated motion of the tool based on the input value, wherein the calculated motion is expressed in an observer coordinate system that is based on the orientation of the tool and the orientation of an observer reference structure;

c. determining a commanded motion of the medical robotic arm based on the calculated motion and the position of the medical robotic arm;

d. outputting an actuation signal to move the medical robotic arm in accordance with the commanded motion;

e. determining a calculated observer force value that is expressed in the observer coordinate system;

f. determining a controller device feedback force value based on the calculated observer force value, wherein the controller device feedback force is expressed in the controller device coordinate system; and

g. outputting a feedback signal to the controller device in accordance with the controller device feedback force value.

131. The method of claim 130, wherein the tool is held by the robotic arm.

132. The method of claim 130, wherein the tool has a tool axis, and the observer coordinate system comprises an axis that corresponds to the tool axis.

133. The method of claim 132, wherein:

the input value can be expressed in the controller device coordinate system as an input vector having an input magnitude and an input direction;

the calculated motion can be expressed in the observer coordinate system as a calculated motion vector having a calculated motion magnitude and a calculated motion direction; and

the calculated motion direction equals the input direction.

134. The method of claim 133, wherein the determining of the calculated observer force value comprises using a virtual force value.

135. The method of claim 133, further comprising:

h. receiving a measured force value from the medical robotic arm, wherein the measured force value is representative of a force measured at a location on the medical robotic arm and expressed in a sensor coordinate system; and

where;

the determining of the calculated observer force value comprises using the measured force value and the position of the medical robotic arm.

136. The method of claim 135, wherein the determining of the calculated observer force value further comprises using a virtual force value.

140. The method of claim 136, wherein calculation of the virtual force value comprises using one or more calculated virtual collisions, one or more joint limits, motion divergence or a combination thereof.

157. A computer readable medium comprising machine readable instructions for performing the method according to claim 130.

159. A control system for use in control of at least one medical robotic arm, the control system configured in accordance with the method according to claim 130.

137-139. -139. (canceled)

141-155. -155. (canceled)