This invention relates generally to motion control systems and methods, and more particularly relates to a system and method for reducing or eliminating uncontrolled motion in a motion control system.
The usage of feedback control loops in controlling motion of a device is very common. However there may occur errors in the control loop, which may result in uncontrolled motion of the device. Generally an encoder or sensor along with a controller is used in a feedback loop to control the operation of a motor, which in turn drives a device directly or via one or more gears or other transmission. Due to events like encoder or sensor failure or the cable that carries the signal from the encoder or sensor being disconnected, the signals from the encoder or sensor are not properly carried to the controller and hence the loop is not closed and may result in random or abrupt movement of the device. It is typically desirable to reduce or eliminate such uncontrolled device motion.
Generally, a positioner in a medical imaging system is used for positioning of a patient with respect to a medical imaging device, either by moving the patient or the medical imaging device. Examples of medical imaging devices may include X-ray devices and vascular imaging devices. One example of a positioner is a vascular gantry comprising a C-arm and a pivot axis. The positioner includes mechanisms for lift and pivot in a vascular gantry and longitudinal and lateral tilt in a patient table. In certain positioners, velocity and position encoders are provided along with a controller that uses velocity and position feedback control loops to control the motion of the positioner.
Considering an example of a vascular tilt table, during an axis movement, if the velocity encoder signal is lost due to encoder cable fault or encoder malfunction then the velocity control loop will become unstable and create an uncontrolled motion on the axis. This will interrupt an on going medical procedure. It will also be difficult to unload the patient, because after the encoder fault, the axis will not be usable until the encoder issue is resolved.
Some of the solutions in the industry suggest detecting encoder signal loss using over speed detection logic and then applying brakes for the axis. However, the over speed detection and brake application will take a relatively long time, partly due to the time required to actuate the brake, which is typically electromagnetic. In addition, on actuation of the brake, the equipment will not be capable of use until the problem is fixed.
Some of the solutions suggest detecting a feedback failure and changing over from a closed control loop to an open control loop. However usage of open control loop is often not desirable due to the decrease in control accuracy.
Thus there exists a need to provide a method to reduce or eliminate uncontrolled motion in a device which uses feedback loop, especially when the uncontrolled motion is caused due to the failure of an encoder/sensor used in the feedback loop.
The above-mentioned shortcomings, disadvantages and problems are addressed herein which will be understood by reading and understanding the following specification.
The present invention provides a method of reducing or eliminating uncontrolled motion in a motion control system. The method includes the step of: defining at least one closed motion control loop, the motion control loop being configured to include a plurality of feedback control loops. The method further includes the step of detecting a faulty feedback control loop from among the plurality of feedback control loops based on a faulty feedback signal. The method further includes the step of swapping of the faulty feedback signal in the faulty feedback control loop with an operative feedback signal while the motion control loop is active. In an embodiment, the motion control loop includes a position feedback control loop and a velocity feedback control loop. Upon failure of position or velocity control loop, the faulty encoder is swapped with an operative encoder so that the motion control loop is complete.
In another embodiment, a motion control mechanism is disclosed. The mechanism includes: a faulty encoder detector; and a feedback control mechanism for swapping a faulty encoder detected by the faulty encoder detector with an operative encoder in an active closed motion control loop. In an embodiment, the feedback control mechanism is configured to select an operative feedback sensor in the event of detection of a faulty feedback sensor in active motion control loop. Once the operative feedback sensor is selected the faulty feedback sensor is swapped with the operative feedback sensor.
In yet another embodiment, a motion control system is disclosed. The system includes: a motion control loop defined by a plurality of feedback control loops; a motion control mechanism operatively coupled to motion control loop; and a motor drive coupled to motion control mechanism; wherein the motion control mechanism is configured to eliminate uncontrolled motion caused due failure of a feedback control loop in the motion control system.
Various other features, objects, and advantages of the invention will be made apparent to those skilled in the art from the accompanying drawings and detailed description thereof.
A clear conception of the advantages and features constituting inventive arrangements, and of various construction and operational aspects of typical mechanisms provided by such arrangements, are readily apparent by referring to the following illustrative, exemplary, representative, and non-limiting figures, which form an integral part of this specification, in which like numerals generally designate the same elements in the several views, and in which:
In the following detailed description, reference is made to the accompanying drawings that form a part hereof, and in which is shown by way of illustration specific embodiments that may be practiced. These embodiments are described in sufficient detail to enable those skilled in the art to practice the embodiments, and it is to be understood that other embodiments may be utilized and that logical, mechanical, electrical and other changes may be made without departing from the scope of the embodiments. The following detailed description is, therefore, not to be taken as limiting the scope of the invention.
In various embodiments, a method and system for reducing or eliminating uncontrolled motion in a motion control system is disclosed. The system allows swapping of a faulty feedback signal in a feedback control loop with an operative feedback control signal, based on the faulty feedback loop signal. in the event of an encoder failure or encoder malfunction. The swapping is done while the motion control system is active or operative.
In an embodiment the invention facilitates enabling a degraded mode of operation wherein even after detecting failure of a feedback control loop the device is allowed to complete at least one motion control cycle so that the ongoing operation of the device is not interrupted for at least one cycle.
In another embodiment, a motion control mechanism is disclosed. The motion control mechanism disclosed can be used in various closed motion control loops. A motion control system may be configured to have plurality of motion control loops. The motion control loop may include plurality of feedback control loops for controlling the motion of the device. The feedback control loop may be defined through an encoder and a controller. The motion control mechanism described is applicable to any motion control loops, wherein there are two or more feedback control loops, so that if an encoder or feedback sensor in the encoder of one feedback control loop fails, the motion control loop can be completed through an operative encoder or an operative feedback sensor in another feedback control loop.
In another embodiment, the invention provides a motion control system for a positioner. The motion control system is operated through a motion control loop. The motion control loop includes a position feedback control loop and velocity feedback control loop. The position control loop and the velocity control loop use a position feedback signal and a velocity feedback signal respectively. In the event of a faulty position feedback signal or velocity feedback signal, the motion control loop is completed through an operative velocity feedback signal or operative position feedback signal.
While the present technique is described herein with reference to medical imaging applications and, it should be noted that the invention is not limited to this or any particular application or environment. Rather, the technique may be employed in a range of applications where motion of a device is being controlled by a closed motion control loop comprising at least two feedback control loops.
The motion control mechanism 300 includes the faulty encoder detector 310. The faulty encoder detector 310 may detect the malfunction or failure of the encoder more specifically failure of a feedback sensor and its interface circuitry, in a feedback loop. The faulty encoder detector 310 is configured to check the encoder continuously, at least one time in each motion control cycle. The encoder generally sends a signal to the faulty encoder detector that indicates that the feedback sensor in the encoder is functional or the feedback control loop is operative. The faulty encoder detector 310 can be any detection circuit including hardware, software or firmware detectors that can detect a feedback sensor failure or feedback control loop failure. The faulty encoder detector 310 is configured to generate a faulty feedback signal based on the non-availability of the signal from the feedback sensor. This faulty feedback signal is fed to the feedback control mechanism 320.
The feedback control mechanism 320 is operably coupled to the faulty encoder detector 310 for receiving the faulty feedback signal. The feedback control mechanism 320 is configured to select an operative feedback sensor in a feedback control loop 360 in the event of detection of a faulty feedback control loop 360 and bypass the faulty feedback sensor in the faulty feedback control loop with an operative feedback sensor so that the motion control loop 350 remains closed. The feedback control mechanism 320 in responsive to the input from the faulty encoder detector 310 will select an operative feedback control loop 360. Once an operative feedback sensor/encoder in an operative feedback control loop is selected, the output of the selected feedback sensor/encoder is scaled based on the nature of the faulty feedback sensor. The scaled output is fed to the controller through an error signal generator for completing the motion control loop 350. The scaling step can be optional, based on the usage of the speed reduction mechanism used between the encoders. The scaling factor depends on the speed reduction ratio used between the encoders in the motion control loop.
In an embodiment a motion control mechanism 490 is provided to reduce or eliminate the uncontrolled motion in the motion control system. The motion control mechanism 490 includes faulty encoder detector 492 and a feedback control mechanism 494. The feedback control mechanism 494 includes a selecting unit 495 and a scaling unit 496. The faulty encoder detector 492 is operably coupled to the encoders for detecting the failure of a position encoder 480 or a velocity encoder 470. The faulty encoder detector 492 checks continuously, at least once in each motion cycle, for a signal from the encoders. The faulty encoder detector 492 is configured to generate a faulty feedback signal based on the non-availability of a signal from the position encoder 480 or velocity encoder 470, more specifically from non-availability of signal from the position sensor 485 and velocity sensor 475 in the encoders. This faulty feedback signal indicates the presence of a faulty sensor or a faulty encoder or a faulty feedback control loop. The feedback control mechanism 492 is configured to complete the motion control loop for at least one motion cycle even after detecting a faulty feedback control loop. Based on the faulty feedback signal, the selecting unit 495 will select an operative feedback signal or an operative encoder. The selecting unit 495 is configured for selecting an operative encoder in the event of detection of a faulty feedback control loop or faulty encoder. Once the operative encoder is selected, the output of the operative encoder is scaled using the scaling unit 496, scaling factor being dependent on a speed reduction mechanism 478 used between the encoders. Thus the motion control loop 400 is completed through the selected sensor in the selected encoder.
The motion control mechanism 490 is operably coupled to the motion control loop 400 for controlling the motion of the device. The motion control loop 400 controls the operation of the motor drive 460 to stabilize the velocity and position of the device based on the error signals generated using the feedback control loops. The selecting unit is explained in reference to
Some of the advantages of the invention include reducing or eliminating the uncontrolled motion caused due to failure or malfunction of an encoder in a motion control loop. Especially it eliminates the uncontrolled motion that can happen due to the failure of a position or velocity encoder in a feedback loop. The invention allows to control the erroneous motion which can occur in different axis. In medical imaging applications, this reduces the jerk of the patient experienced on a positioner while an uncontrolled motion occurs in the motion control system. The invention reduces the distance that need to be traveled before controlling the erroneous motion. The checking and controlling can be facilitated through an FPGA and hence can be achieved quickly. Thus the mechanism will reduce the stop distance well within the safety limits. As a result of reducing the uncontrolled motion, it eliminates the risk of collision of patient with gantry, X-ray detector or any other equipment in the vicinity. In another aspect the invention facilitate degraded mode of operation for at least one motion control cycle so that it will facilitate to complete the on going procedure and help to unload the patient safely in case of a medical imagining application. The motion control mechanism is a cost effective solution since it can be achieved through firmware. The encoder swapping occurs from the next motion control cycle onward and hence the user will not feel any jerk or shake because of the swapping. As the mechanism is achieved using digital techniques the controlling is very quick and the swapping occurs within I ms.
Thus various embodiments of the invention describe erroneous motion control system and method. Also in an embodiment the invention disclose effective way of detecting an encoder failure and swapping the faulty encoder with an operative encoder in the next motion control cycle.
While the invention has been described with reference to preferred embodiments, those skilled in the art will appreciate that certain substitutions, alterations and omissions may be made to the embodiments without departing from the spirit of the invention. Accordingly, the foregoing description is meant to be exemplary only, and should not limit the scope of the invention as set forth in the following claims.