STEERABLE, FOLLOW THE LEADER DEVICE
20190274521 ยท 2019-09-12
Inventors
Cpc classification
A61B1/31
HUMAN NECESSITIES
A61B1/0052
HUMAN NECESSITIES
A61B2034/2063
HUMAN NECESSITIES
A61B2017/3445
HUMAN NECESSITIES
A61B34/70
HUMAN NECESSITIES
A61B1/05
HUMAN NECESSITIES
A61B90/11
HUMAN NECESSITIES
A61B2017/00327
HUMAN NECESSITIES
A61B34/20
HUMAN NECESSITIES
A61B1/0055
HUMAN NECESSITIES
A61B90/10
HUMAN NECESSITIES
A61B1/0053
HUMAN NECESSITIES
A61B2017/00336
HUMAN NECESSITIES
A61B2034/301
HUMAN NECESSITIES
International classification
A61B1/05
HUMAN NECESSITIES
A61B90/10
HUMAN NECESSITIES
A61B1/31
HUMAN NECESSITIES
A61B34/00
HUMAN NECESSITIES
A61B1/00
HUMAN NECESSITIES
Abstract
A highly articulated robotic probe (HARP) is comprised of a first mechanism and a second mechanism, one or both of which can be steered in desired directions. Each mechanism can alternate between being rigid and limp. In limp mode the mechanism is highly flexible. When one mechanism is limp, the other is rigid. The limp mechanism is then pushed or pulled along the rigid mechanism. The limp mechanism is made rigid, thereby assuming the shape of the rigid mechanism. The rigid mechanism is made limp and the process repeats. These innovations allow the device to drive anywhere in three dimensions. The device can remember its previous configurations, and can go anywhere in a body or other structure (e.g. jet engines). When used in medical applications, once the device arrives at a desired location, the inner core mechanism can be removed and another functional device such as a scalpel, clamp or other tool slid through the rigid sleeve to perform. Because of the rules governing abstracts, this abstract should not be used to construe the claims.
Claims
1.-41. (canceled)
42. A method of operating a highly articulated probe, the method comprising: receiving, by a computing device, position data from an input device, wherein the position data is associated with a highly articulated probe that comprises a first mechanism and a second mechanism configured to surround at least a portion of the first mechanism; translating, by the computing device, the position data into coordinate system data; and causing, by the computing device, a position of one or more shafts of one or more motors to be varied based on the coordinate system data, wherein the one or more motors are configured to control a tension of one or more wires of the second mechanism.
43. The method of claim 42, further comprising: receiving, by the computing device, an instruction from the input device to lock a position of the second mechanism; causing one or more of the one or more motors to be driven in a direction opposite a pull of the one or more wires; and causing one or more motors associated with the first mechanism to be driven in a direction of a pull of one or more wires associated with the first mechanism.
44. The method of claim 42, further comprising: causing one or more motors associated with the first mechanism to advance the first mechanism a distance equal to approximately a length of one of a plurality of links of the first mechanism; and locking a position of the first mechanism.
45. The method of claim 44, further comprising: causing one or more of the motors that are configured to control one or more wires of the second mechanism to advance the second mechanism a distance equal to approximately a length of one of a plurality of links of the second mechanism; and locking a position of the second mechanism.
46. The method of claim 42, wherein: the one or more motors comprises a first motor, a second motor, and a third motor, the one or more wires comprise a first wire, a second wire, and a third wire, the first motor is configured to control a tension of the first wire, the second motor is configured to control a tension of the second wire, the third motor is configured to control a tension of the third wire.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0025] For the present disclosure to be easily understood and readily practiced, various embodiments of the present disclosure will now be described, for purposes of illustration and not limitation, in conjunction with the following figures wherein:
[0026]
[0027]
[0028]
[0029]
[0030]
[0031]
[0032]
[0033]
[0034]
[0035]
[0036]
[0037]
[0038]
[0039]
[0040]
[0041]
[0042]
[0043]
[0044]
DESCRIPTION
[0045] A highly articulated robotic probe (HARP) 10 of one embodiment of the present disclosure shown in.
[0046] With this HARP 10, one mechanism starts limp and the other starts rigid. For the sake of explanation, assume the sleeve 14 is rigid and the core 12 is limp, as seen in step 1 in
[0047] in medical applications, once the HARP 10 arrives at: a desired location, the surgeon can remove the inner core 12 and slide either a conventional device or a custom tool through the rigid sleeve 14 to perform various operations.
[0048] The HARP 10 is not limited to surgery, but can be used in engine inspection, engine repairs, and engine retrofitting. Other applications include tank inspection, spying or surveillance-applications, bomb disarming, and inspection or repairs in tightly confined spaces such as submarines or within nuclear weapons. Other applications include structural (e.g. building) inspections, hazardous waste remediation and bioterrorists sample recovery. Clearly, the device of the present disclosure has a wide variety of applications and should not be taken as being limited to any particular application.
[0049] The HARP 10 of the present disclosure device bears some similarities to Bob Sturges' patented device (U.S. Pat. No. 5,759,151) although the present disclosure incorporates several major innovations. First, the core 12 and/or sleeve 14 is steerable. Second, the sleeve 14 can be made both rigid and limp. These two innovations allow the HARP 10 to drive anywhere in three-dimensions. Sturges' device assumes that it is moving through a tubular space, such as the large intestines. Sturges' device requires that the intestines shape the device as it goes. As Sturges' device propagates out it, cannot remember its previous configuration and hence cannot keep the path it followed due to the fact that it is composed of only one element that can become both rigid and stiff The HARP 10 can remember its previous configurations and for this reason, the HARP 10 can go anywhere in a three dimensional volume such as the intracavity spaces in a body.
[0050] The following discussion contains details of a preferred embodiment. The reader should recognize that the present disclosure is not to be limited by the detailed information that follows. Rather, the detailed information is intended for purposes of illustration and not limitation. As can be seen in
[0051]
[0052] The heads (i.e. the distal cylinders) of both the sleeve 14 and the core 12 are steerable using three cables which are attached at, for example, 120 from each other. As can be seen in
[0053] It will be appreciated that although the preferred embodiment described above utilizes cables or wires, alternative means of manipulating the limp elements, such as miniature pneumatic or hydraulic cylinders or other mechanical linkages situated between individual links, can be employed without falling outside the scope of this invention.
[0054] The links, and hence the HARP 10, can be made out of virtually any material, including plastic, which allows it to be used online with NMR. One current prototype of our device has an outer diameter of the outer sleeve 14 of 12 mm and an outer diameter of the inner core 12 of 6 mm. The choice of 12 mm is based on available port sizes. Each link of the outer sleeve 14 weighs 1.5 grams and each link of the inner core 12 weighs 0.5 grains. Currently, the number of links in each of the inner core 12 and outer sleeve 14 is seventeen. Therefore, the total weight of the device 10 is thirty-four grams and its total length is 300 mm. These dimensions are intended for purposes of illustration and not limitation.
[0055] As noted, the core 12 and sleeve 14 can be made rigid or limp using wires or cables. Although there are many variations, in the current prototype the outer sleeve 14 consists of a set of cylinders 22 strung on three wires. The three wires are 120 apart, making it possible to steer in any direction. This design provides a radius of curvature of approximately eight centimeters. When the wires are pulled towards the back of the sleeve 14, the cylinders 22 are pulled towards each other. When the pulling force increases, the friction force between adjacent cylinders 22 increases until the whole outer sleeve 14 stiffens (i.e. enters the rigid mode). When the pulling force is released, the outer sleeve 14 becomes limp. Thus, the wires together with their respective motors form a locking device. The motors, along with the electronics for controlling the motors, form a means for controlling the tension on the wire. When the outer sleeve 14 is positioned one cylinder in front of the inner core 12, and the inner core 12 is stiff, the distal link of the outer sleeve 14 can be oriented by pulling one or more of the three wires. The magnitude of the pulling force which is exerted on each wire can he controlled. By pulling the three wires with the same magnitude, the outer sleeve 14 becomes stiff without changing its shape.
[0056] The inner core 12, like the outer sleeve 14, consists of a set of cylinders. In contrast to the outer sleeve 14, the inner core 12 does not need (but may optionally have) a steering ability. The inner core 12 does need the ability to change from rigid mode, to limp mode, and back. Therefore, in embodiments where the inner core 12 need not be steerable, the links of the inner core 12 may be strung on a single wire, which enables a small diameter for the device 10.
[0057] One type of feeding mechanism 16, shown in
[0058] Each of the carts 42, 44 carries one or more motors necessary for controlling the wires of the inner core 12 and outer sleeve 14. For example, as seen in
[0059] For the 12 mm diameter HARP 10, the feeder's 16 dimensions are 400 mm (long) by 100 mm (width/height), while the HARP is 300 mm long. The 12 mm prototype HARP 10 is inserted into a protective plastic bag to achieve sterility. However, the device can be constructed out of inexpensive ABS plastic rendering the device disposable.
[0060] We selected motors to handle the worst case configuration for the device, i.e. when the motors tensioning the wires have to exert the most torque. The worst case configuration is when the HARP 10 is stretched out in a cantilever position, the outer sleeve 14 is limp, and the inner core 12 supports its own weight as well as the weight of the outer sleeve 14.
[0061] To estimate the axial force needed to be applied by the wire 59 of the inner core 12 to support this configuration, we use a simplified model of this extreme configuration. The simplified model is shown in
[0062] The weight of the device is simplified to a point mass at the center of gravity of the device. The largest torque is exerted on the area between the two proximal cylinders of the HARP 10. Therefore we developed a simplified model to include only one long cylinder that is in contact with the proximal cylinder. The wire of the inner core is applied with an axial force, F, at the center of the HARP 10. A free body diagram of the simplified model is shown in
[0063] The approximated relation between the force F and the torque applied on a circular surface with radius r and friction coefficient is shown in equation (1).
It is clear from equation (1) that the friction coefficient is an important design criteria. When the friction between cylinders is low, the pulling force that is needed to withstand the mechanism's own weight is enormous. To find the accurate friction coefficient between cylinders some empirical tests were needed.
[0064] Three different materials were tested: Aluminum T6061-T6, Garolite G11/FR5 and Garolite G10/FR4. The aluminum and Garolite G11/FR5 had a friction coefficient of approximately 0.2-0.3, but after a few minutes of being rotated under load, the contact surface was polished and smoothed out, and the friction coefficient dropped dramatically making these materials unfit for our design. The Garolite G10/FR4, which is a high pressure laminated glass reinforced epoxy, has a very high friction coefficient (approximately 0.5) and was durable to polishing. This material is also MRI compatible.
[0065] Based on these tests, we decided to use the Garolite G10/FR4. This material enabled the use of reasonable pulling force of the wire (approximately 35-40 N) to hold the weight of the entire device in the extreme configuration described above. Furthermore, this pulling force was sufficient to withstand additional torques caused by steering the distal link of the outer sleeve.
[0066] An implication of using the Garolite G10/FR4 was the need for a non-abrasive wire. Therefore we used the Spectra polyethylene fiber wire, with 0.030 diameter, a breaking force of 150 lbf, and a low stretch (about 3%). An additional advantage of the Spectra wire is its very tight radius curvature that enabled the use of a small diameter pulley (4 mm diameter) making it possible to achieve a high pulling force per torque.
[0067]
[0068]
[0069] The quadrature chip 96 decodes the two channel encoder data from a motor encoder and outputs up and down clocks which are fed into the microcontroller 95. The microcontroller 95 uses its counter circuits to count the forward and reverse movements of the motor shaft to calculate the current position of the motor shaft
[0070] The H-bridge chip 97 is used to drive the motor. This chip takes a PWM signal and a direction signal as input from the microcontroller 95 and switches the motor on and off according to these signals. This chip handles the higher currents and voltages required by the motor which are beyond the capabilities of the microcontroller 95 outputs.
[0071] The third chip is the quad op-amp. This chip is used entirely for motor current monitoring. One amplifier 98 is used in a non-inverting configuration with a gain of 74.2 with its output fed to one of the microcontroller's 95 analog to digital pins. A second amplifier 99 is configured as a non-inverting amplifier with a gain of 500 and is also connected to an analog to digital pin of the microcontroller 95. This higher gain gives a more precise current measurement at lower current values. A third amplifier 100 is used to control a current source which drives an LED with current proportional to the motor current. This, along with an LED which indicates the direction of motion, gives the operator a clear visual indication of what the controller 74 is doing.
[0072] The microcontroller (PIC) 95 is the heart of this board. This chip features an I.sup.2C; bus peripheral which is used for communication with the host computer 62. This is a two way link used to send commands from the computer 62 to the controller 74, while status information flows back from the controller 74 to the computer 62. The commands from the computer 62 are related to position goals and current limits. The status sent back to the computer 62 includes motor electrical current measurements and motor encoder values.
[0073] The primary role of the microcontroller 95 is to run a PID position control loop. The purpose of this PID loop is to minimize the error between the motor encoder count and a dynamically generated position goal. This position goal is generated by another component of the microcontroller program, the trajectory generation system.
[0074] The trajectory generation system of controller 74 creates goals based on a final goal supplied over the I.sup.2C bus, and a desired time-to-goal value also supplied over the I.sup.2C bus, as is known in the art. The trajectory generator uses these values to create a trapezoidal velocity profile to bring the motor to the desired final position in the specified amount of time. This working goal is updated at approximately which is also the frequency of the PID loop.
[0075] Simultaneously, the microcontroller 95 is also taking readings of the motor current via the on chip analog to digital converter. These values are compared against an I.sup.2C bus supplied maximum current value, and if the measured current exceeds the desired maximum, the PWM output to the H-bridge is throttled hack. This also vans at the same frequency as the PID loop.
[0076] The controller 74 is designed to allow multiple controllers 74 to be stacked by utilizing a 40 conductor board to board connector 104, 105 (
[0077] Motors are connected to their respective controllers 74 through a 25 100 mil spacing right angle header 103. This is a versatile connector which allows ribbon cable or discrete wiring to the motors. The motors used on this system were supplied with ribbon cable IDC connectors.
[0078] Each board also features 5 LEDs, one of which is shown in
[0079] Before the system can be used, the first mechanism 12 and the second mechanism 14 must he homed; that is, their relative positions must be determined. This is done by retracting both mechanisms until the linear actuators 46, 48 have reached the end of their range of travel, a condition detected by the system as an increase in actuator current. The control software 68 uses encoder information to record the positions of the first mechanism 12 and second mechanism 14, and homing is complete.
[0080] The control software then puts the system in stepped advancing mode which is illustrated in
[0081] At this point, the software 68 is ready for user input. The software 68 monitors the position of the joystick 70 at 82, translating the two-axis data from the joystick into the three-axis coordinate system of the second mechanism 14. The positions of the shafts of the motors 50, 51, 52 controlling wires 54 55, 56, respectively, are varied at 84 according to the translated joystick position. Once the user has steered the protruding link of the second mechanism 14 to the desired angle, the user presses a button on the joystick 70 to lock that angle in place as shown at 86. The three tensioning motors 50, 51, 52 are driven in the direction opposite the tension wires' 54, 55, 56 pull, until their current limits are reached and the motors stall at 88. This begins with the wire closest to the inside of the angle being formed, progressing after a small fixed delay to the next wire and finally the wire on the outermost part of the angle; tensioning the wires in this order preserves the user-selected angle more accurately than tensioning them simultaneously.
[0082] Once each of the three motors 50, 51, 52 has reached its current limit, the second mechanism 14 is rigid and the first mechanism 12 can safely be made limp as shown by 90 by driving its tensioning motor 58 a fixed number of rotations in the direction of the tension wire's 59 pull. The first mechanism 12 is then advanced by one link's length, so that its distal end is even or coextensive with the second mechanism's 14 distal end as shown by 92 and
[0083] The description of motion in conjunction with
[0084] Although it is anticipated that steering may be achieved through the use of cameras, other mechanisms may be used. For example, the distal links of each of the first mechanism 12 and second mechanism 14 may be comprised of material which is visible through the use of x-rays, NMRI, or other such devices such that the HARP 10 may be steered by tracking the advance of the HARP 10 with such a device. Alternatively, a small amount of radioactive material may be placed on the distal end of each of the first mechanism 12 and second mechanism 14 such that the progress of the HARP 10 can be tacked. Control of the path and configuration of the HARP 10 may he accomplished through the use of intelligent algorithms. The present invention is not to be limited by the type of mechanism used to provide information for steering and/or guidance of the HARP 10.
[0085] The process of retracting the mechanisms takes place in the same way as advancing does, but in reverse order, and without steering input from the user as shown in
[0086] Turning now to experimental results, an off-the-shelf fiber optic based camera and video camera, such as the Olympus PF14 inset don tube 1.4 mm was introduced through the open central portion of the links of an inner core 12 designed to have a 6 mm diameter opening. Another option would be to integrate the video camera into the walls of the links of the outer sleeve 14, which are currently 3 mm thick. With such a device, and as shown in
[0087] The normal pericardium is a double-layered, flask-shaped sac consisting of an outer fibrous envelope and in inner serous sac that is invaginated by the heart. The pericardial cavity or sac is a continuous virtual space that lies between the two opposite layers of serous pericardium. At the pericardial reflections and at the posterior wall between the great vessels, the pericardial space is apportioned into a contiguous network of recesses and sinuses; all pericardial reflections are located basally in relation to the great vessels. Thus, there are no obstacles during intrapericardial navigation along the anterior ventricular surface of the heart. There are three sinuses in the pericardial space: the superior sinus (also referred to as superior aortic recess), the transverse sinus contains several recesses between the major vessels (superior aortic, inferior aortic, right pulmonary and left pulmonary recess). The inferior aortic recess allows access to the epicardial aspect of the noncoronary and right coronary aortic cusps. The oblique sinus extends behind the atria, particularly the left atrium, in the region between the four pulmonary veins. There are five recesses of the pericardial cavity: superior aortic (SAR), inferior aortic (AR), postcaval (PCR), left pulmonary (LPVR) and right pulmonary (RPVR).
[0088] As shown, in
[0089] While the present invention has been described in connection with preferred embodiments thereof, those of ordinary skill in the art will recognize that many modifications, variations and substitutions are possible. For example, as shown in