Mechanical tracking system
09726517 · 2017-08-08
Assignee
Inventors
Cpc classification
A61B5/055
HUMAN NECESSITIES
A61B34/20
HUMAN NECESSITIES
A61B8/0858
HUMAN NECESSITIES
A61B8/085
HUMAN NECESSITIES
A61B8/4263
HUMAN NECESSITIES
A61B90/11
HUMAN NECESSITIES
A61B8/483
HUMAN NECESSITIES
G01D5/26
PHYSICS
International classification
G01B7/30
PHYSICS
G01D5/26
PHYSICS
A61B5/055
HUMAN NECESSITIES
A61B8/00
HUMAN NECESSITIES
G01R33/02
PHYSICS
A61B34/20
HUMAN NECESSITIES
Abstract
A mechanical tracking system comprises a first set of linkage arms, a second set of linkage arms, a pair of shafts connected at a first end to one arm of the first set of linkage arms and at a second end to one arm of said second set of the linkage arms, wherein each arm of the second set of linkage arms is oriented out of phase with a respective arm of the first set of linkage arms, an attachment shaft positioned adjacent to the first set of linkage arms to accommodate a tool, and a sensor arrangement configured to sense the orientation and position of the attachment shaft.
Claims
1. A mechanical tracking system comprising: a first set of linkage arms; a second set of linkage arms; a pair of shafts connected at a first end to one arm of said first set of linkage arms and at a second end to one arm of said second set of said linkage arms, wherein each arm of the second set of linkage arms is oriented out of phase with a respective arm of the first set of linkage arms; an attachment shaft positioned adjacent to the first set of linkage arms to accommodate a tool, wherein the first set of linkage arms and the second set of linkage arms are rotatable about respective first and second centers of motion (FCOM, RCOM) thereby to permit pivoting of a tool accommodated by the attachment shaft about the first center of motion with three degrees of rotation; and a sensor arrangement configured to sense the orientation and position of the attachment shaft.
2. The mechanical tracking system of claim 1 wherein the first and second sets of linkage arms are 180° out of phase with respect to one another.
3. The mechanical tracking system of claim 1 wherein both the first and second sets of linkage arms form spherical linkages.
4. The mechanical tracking system of claim 3 wherein the spherical linkages are coupled to opposite ends of a parallelogram linkage.
5. The mechanical tracking system of claim 4 wherein the first and second sets of linkage arms and parallelogram linkage are coupled to a linear slide assembly.
6. The mechanical tracking system of claim 3 further comprising a counterbalance mechanism for maintaining balance between the first and second sets of linkage arms.
7. The mechanical tracking system of claim 6 wherein said counterbalance mechanism comprises counterweights mounted on said first set of linkage arms.
8. The mechanical tracking system of claim 1 wherein the sensor arrangement comprises at least one encoder.
9. The mechanical tracking system of claim 8 wherein the at least one encoder is one of a magnetic encoder and an optical encoder.
10. The mechanical tracking system of claim 8 wherein the sensor arrangement comprises a plurality of sensors at different locations about the mechanical tracking system.
11. The mechanical tracking system of claim 10 wherein the sensors are encoders.
12. The mechanical tracking system of claim 1 further comprising a motor arrangement for controlling movement of the mechanical tracking system.
13. The mechanical tracking system of claim 1 comprising a pair of brakes configured to selectively inhibit or permit rotation of the first set of linkage arms about the first center of motion (FCOM) and the second set of linkage arms about the second center of motion (RCOM).
14. An assembly comprising: a parallelogram linkage; a first spherical linkage coupled to one end of the parallelogram linkage and being configured to connect to a tool; a second spherical linkage coupled to an opposite end of the parallelogram linkage, the second spherical linkage being 180° out of phase with respect to the first spherical linkage; and a counterbalance mechanism separated from said first spherical linkage, wherein the first and second spherical linkages are rotatable about respective first and second centers of motion (FCOM, RCOM) thereby to permit pivoting of a tool connected to the first spherical linkage about the first center of motion with three degrees of rotation.
15. The assembly of claim 14 wherein the first and second spherical linkages are mirrored at opposite ends of the parallelogram linkage.
16. The assembly of claim 15 wherein the counterbalance mechanism is associated with said second spherical linkage.
17. The assembly of claim 16 wherein the counterbalance mechanism comprises counterweights mounted on linkage arms of said second spherical linkage.
18. The assembly of claim 15 further comprising a shaft and U-joint arrangement extending between said first and second spherical linkages.
19. The assembly of claim 15 wherein said parallelogram linkage and first and second spherical linkages are coupled to a linear slide assembly.
20. The assembly of claim 15 further comprising a sensor arrangement comprising a plurality of sensors at different locations on said assembly.
21. The assembly of claim 14 comprising a pair of brakes configured to selectively inhibit or permit rotation of the first spherical linkage about the first center of motion (FCOM) and the second spherical linkage about the second center of motion (RCOM).
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) Embodiments will now be described more fully with reference to the accompanying drawings in which:
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
DETAILED DESCRIPTION OF THE EMBODIMENTS
(14) Tuning to
(15) The linear sliding assembly 150 comprises a first base bracket 152 having one end configured to be secured or otherwise mounted on supporting structure. A horizontally extending linear carriage 154 is mounted adjacent the other end of the first base bracket. A bottom portion of a second base bracket 156 is slidably connected to the linear carriage 154 via a linear slide 158. A brake 166 is provided to selectively inhibit or permit movement of the linear slide 158 along the linear carriage 154. A top portion of the second base bracket 156 is connected to a yaw bearing block 160. The yaw bearing block 160 supports a rear base plate 162. A first pitch bearing block 164 is connected to the rear base plate 162. Although not visible in
(16) The rearward spherical linkage 200 extends rearwardly from the rear base plate 162 and comprises four (4) spherical linkage arms 202 to 208, which in this embodiment are made of aluminum or other suitable material. The spherical linkage arms 202 to 208 are arranged in a generally rectangular shape and are connected to one another via a pair of stainless steel bearings that are seethed by a threaded screw and a bolt (not shown). Specifically, a first end of each of spherical linkage arms 202 and 206 is connected to opposing ends of spherical linkage arm 204. A second end of spherical linkage arm 206 is connected to a first end of spherical linkage arm 208 and a second end of spherical linkage arm 202 is connected to an approximate midpoint of spherical linkage arm 208. The second end of spherical linkage arm 208 extends generally outward from the connection point of the second end of spherical linkage arm 202. Counterweights 210 formed of tungsten or other suitable material are positioned approximately at the midpoints of spherical linkage arms 202, 204 and 206, at the connection point between the first end of spherical linkage arm 202 and spherical linkage arm 204, and at the second end of spherical linkage arm 208. As will be further described below, the rearward spherical linkage 200 is used to counterbalance the mass of the forward spherical linkage 300 and tool connected thereto via attachment shaft 310.
(17) The arm assembly 250 extends forwardly from the rear base plate 162 and is in the form of a parallelogram linkage that comprises an upper parallelogram linkage arm 252 and a lower parallelogram linkage arm 254, respectively. In this embodiment, each of the upper and lower parallelogram linkage arms 252 and 254 is U-shaped and is connected at a first end to the rear base plate 162 via is pair of stainless steel bearings associated with the first pitch bearing block 164 and second pitch bearing block (not shown), and at a second end to a forward base plate 256 via a pair of stainless steel bearings associated with a third pitch bearing block 258 and a fourth pitch bearing block (not shown). Positioned within a space intermediate the upper parallelogram linkage arm 252 and the lower parallelogram linkage arm 254 is the spring counterbalance assembly 260. The spring counterbalance assembly 260 is similar to that described in International PCT Application Publication No. WO 2009/039659 to Bax et al., the relevant portions of the disclosure of which are incorporated herein by reference.
(18)
(19) Referring back to
(20) As can be seen, spherical linkage arms 202, 204, 206 and 208 correspond to spherical linkage arms 302, 304, 306 and 308, respectively and thus, the rear and forward spherical linkages 200 and 300 are mirrored at opposite ends of the parallelogram linkage. The rearward spherical linkage 200 and forward spherical linkage 300 are coupled to one another via shaft and U-joint arrangements. The shafts 350a and 350b of the arrangements in this embodiment are parallel and are made of stainless steel or other suitable material. The rearward spherical linkage 200 is connected to a first end of each of the shafts 350a and 350b via a pair of U-joints 352. Each pair of U-joints 352 is connected to one another such that they are 90° out of phase with respect to one another. The forward spherical linkage 300 is connected to a second end of each of the shafts 350a and 350b via a pair of U-joints 354. Each pair of U-joints 354 is connected to one another such that they at 90° out of phase with respect to one another. As a result, the rearward spherical linkage 200 and forward spherical linkage 300 are positioned 180° out of phase with respect to one another, that is, spherical linkage arms 202, 204, 206 and 208 are 180° out of phase with respect to spherical linkage arms 302, 304, 306 and 308, respectively.
(21)
(22) As best shown in
(23) The position of the tool attached to attachment shaft 310 is tracked by the sensor arrangement 400 relative to a fixed coordinate frame. The sensor arrangement 400 is identified in
(24) Referring to
(25)
where x.sub.1, x.sub.2, x.sub.3 and x.sub.4 are constants determined from the geometry of the forward spherical linkage 300, z.sub.1 is the displacement along the linear carriage 154 measured by encoder S1, angle A is the yaw angle measured by encoders S2 and S3, and angle B is the pitch angle measured by encoders S2 and S3.
(26) The orientation of the tool is determined by calculating the orientation of point C using data obtained by encoders S4, S5 and S6. The orientation of the tool about the axis from the forward center of motion ECOM to point C, referred to as axis FCOM-C, is measured by encoder S6. The location of point C with respect to the forward center of motion FCOM is measured by encoders S4 and S5. The orientation of the tool is specified in spherical coordinates by the angle φ, the angle axis FCOM-C makes with respect to the z axis, and the angle θ representing the orientation of the tool in the x-y plane.
(27) The relationship between the coordinate system of the mechanical tracking system 100 and the reference frame defined by the encoders S1 to S6 is shown in
(28) The kinematics equations of motion for the forward spherical linkage 300 derived by applying the Napier analogies to spherical triangle ADC shown in
(29)
(30) As will be appreciated, Equations 2a to 2c are used to define the spherical coordinates of axis FCOM-C in terms of the geometric configuration of the linkage angles ψ and ζ.
(31) The configuration of the forward spherical linkage 300 in terms of the angles measured by encoders S4 and S5 is defined according to Equations 3a and 3b below. It will be appreciated that Equations 3a and 3b are derived by solving the right spherical triangle ABE in
(32)
(33) The positions of spherical linkage arms 306 and 308 of forward spherical linkage 300 correspond to arms AB and BC, respectively. Accordingly, the position of each spherical linkage arm 306 and 308 is determined by measuring the spherical angles at each of the pinned couplings A and B, respectively. Encoder S4 measures the angle (ξ+ζ) between arm AB and the x-Z plane, and encoder S5 measures the angle γ between arm AB and arm BC. As will be appreciated, Equations 3a and 3b are used to decouple the values for angles ξ and γ, which in turn are used to solve Equations 2a to 2e, above.
(34) During operation, the general purpose computing, device (not shown) polls the encoders S1 to S6 to obtain coordinates therefrom in this embodiment, the general purpose computing device polls each encoder S1 to S6 at a one of 10 polls per second. The general purpose computing device processes the coordinates and displays the coordinates of the tool attached to the attachment shaft 310. In embodiments where the tool is a medical imaging device, the general purpose computing device may superimpose the coordinates or tool path of the medical imaging device on a display screen atop a reconstructed image such as for example an ultrasound image, a computed tomography (CT) image, or a magnetic resonance (MR) image. Further, if the tool is a CT or MR imaging scanner, the mechanical tracking system may automatically register the tool to the reconstructed CT or MR image providing information about the tool location relative to the scanned anatomy.
(35) Turning now to
(36) As will be appreciated, motor arrangement 500 is used as a power assist device for lifting and manipulating large payloads and/or a master-slave robotic assistant when coupled to a general purpose computing device (not shown). When used as a master-slave robotic assistant, the sensor data obtained by encoders S1 and S6 is communicated to the general purpose computing device for processing to control motors M1 to M6 and thus, adjust the position and orientation of the tool. As will be appreciated, the orientation and position of the mechanical tracking system (and thus the tool) may be adjusted through any input device such as for example a mouse, a keyboard, a tracking ball, etc.
(37) Turning now to
(38) Although in the above embodiments, components are described as being formed of specific materials such as aluminum and stainless steel, it will be appreciated that other suitable materials may be used such as for example plastic, brass, ceramic, etc.
(39) Although in the embodiments described above, magnetic rotary encoders are used, those skilled in the art will appreciate that non-magnetic optical encoders or other suitable sensors may be used.
(40) Although the counterbalance springs are described above as being made of a steel ally those skilled in the an will appreciate plastic left springs or other suitable spring-like devices may be used.
(41) As mentioned previously, the attachment shaft 310 may be used to connect to a medical tool. An example of the attachment shaft 310 connected to an ultrasound imaging device 800 is shown in
(42)
(43) Although in above embodiments, the spring counterbalance assembly comprises upper and lower cranks, in another embodiment the upper and lower cranks may be replaced with two eccentric cams positioned 90 degrees out of phase with respect to another.
(44) Although it is described above that the position and orientation of the mechanical tracking system (and thus the tool) may be adjusted through any input device such as for example a mouse, a keyboard, a tracking ball, etc., those skilled in the art will appreciate that the position and orientation of the mechanical tracking system may be adjusted using any type of input device. For example, a scaled down model of the mechanical tracking system may be provided to a user and coupled to the general purpose computing device. In this example, the user may manipulate the sealed down model and in response, the mechanical tracking system is automatically conditioned to mirror the resultant movement of the scaled down model. As another example, a graphical user interface (GUI) maY be displayed On a display screen associated with the general purpose computing device providing a number of control buttons to the user. Further, the control buttons may be associated with a predefined movement and orientation pattern preset by the user.
(45) Although embodiments are described above with reference to the accompanying drawings, those skilled in the art will appreciate that variations and modifications may be made without departing from the scope thereof as defined by the appended claims.