US11877805B2 - Trajectory planning for a medical robot system - Google Patents
Trajectory planning for a medical robot system Download PDFInfo
- Publication number
- US11877805B2 US11877805B2 US18/110,071 US202318110071A US11877805B2 US 11877805 B2 US11877805 B2 US 11877805B2 US 202318110071 A US202318110071 A US 202318110071A US 11877805 B2 US11877805 B2 US 11877805B2
- Authority
- US
- United States
- Prior art keywords
- robot system
- medical robot
- arm
- reference vector
- component
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/10—Computer-aided planning, simulation or modelling of surgical operations
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/30—Surgical robots
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B6/00—Apparatus or devices for radiation diagnosis; Apparatus or devices for radiation diagnosis combined with radiation therapy equipment
- A61B6/04—Positioning of patients; Tiltable beds or the like
- A61B6/0407—Supports, e.g. tables or beds, for the body or parts of the body
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B6/00—Apparatus or devices for radiation diagnosis; Apparatus or devices for radiation diagnosis combined with radiation therapy equipment
- A61B6/10—Safety means specially adapted therefor
- A61B6/102—Protection against mechanical damage, e.g. anti-collision devices
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B6/00—Apparatus or devices for radiation diagnosis; Apparatus or devices for radiation diagnosis combined with radiation therapy equipment
- A61B6/40—Arrangements for generating radiation specially adapted for radiation diagnosis
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B6/00—Apparatus or devices for radiation diagnosis; Apparatus or devices for radiation diagnosis combined with radiation therapy equipment
- A61B6/42—Arrangements for detecting radiation specially adapted for radiation diagnosis
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B6/00—Apparatus or devices for radiation diagnosis; Apparatus or devices for radiation diagnosis combined with radiation therapy equipment
- A61B6/44—Constructional features of apparatus for radiation diagnosis
- A61B6/4429—Constructional features of apparatus for radiation diagnosis related to the mounting of source units and detector units
- A61B6/4435—Constructional features of apparatus for radiation diagnosis related to the mounting of source units and detector units the source unit and the detector unit being coupled by a rigid structure
- A61B6/4441—Constructional features of apparatus for radiation diagnosis related to the mounting of source units and detector units the source unit and the detector unit being coupled by a rigid structure the rigid structure being a C-arm or U-arm
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B6/00—Apparatus or devices for radiation diagnosis; Apparatus or devices for radiation diagnosis combined with radiation therapy equipment
- A61B6/54—Control of apparatus or devices for radiation diagnosis
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B6/00—Apparatus or devices for radiation diagnosis; Apparatus or devices for radiation diagnosis combined with radiation therapy equipment
- A61B6/54—Control of apparatus or devices for radiation diagnosis
- A61B6/547—Control of apparatus or devices for radiation diagnosis involving tracking of position of the device or parts of the device
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G13/00—Operating tables; Auxiliary appliances therefor
- A61G13/02—Adjustable operating tables; Controls therefor
- A61G13/04—Adjustable operating tables; Controls therefor tiltable around transverse or longitudinal axis
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61G—TRANSPORT, PERSONAL CONVEYANCES, OR ACCOMMODATION SPECIALLY ADAPTED FOR PATIENTS OR DISABLED PERSONS; OPERATING TABLES OR CHAIRS; CHAIRS FOR DENTISTRY; FUNERAL DEVICES
- A61G13/00—Operating tables; Auxiliary appliances therefor
- A61G13/02—Adjustable operating tables; Controls therefor
- A61G13/06—Adjustable operating tables; Controls therefor raising or lowering of the whole table surface
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- G—PHYSICS
- G16—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS
- G16H—HEALTHCARE INFORMATICS, i.e. INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR THE HANDLING OR PROCESSING OF MEDICAL OR HEALTHCARE DATA
- G16H40/00—ICT specially adapted for the management or administration of healthcare resources or facilities; ICT specially adapted for the management or operation of medical equipment or devices
- G16H40/60—ICT specially adapted for the management or administration of healthcare resources or facilities; ICT specially adapted for the management or operation of medical equipment or devices for the operation of medical equipment or devices
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B34/00—Computer-aided surgery; Manipulators or robots specially adapted for use in surgery
- A61B34/10—Computer-aided planning, simulation or modelling of surgical operations
- A61B2034/107—Visualisation of planned trajectories or target regions
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B90/00—Instruments, implements or accessories specially adapted for surgery or diagnosis and not covered by any of the groups A61B1/00 - A61B50/00, e.g. for luxation treatment or for protecting wound edges
- A61B90/36—Image-producing devices or illumination devices not otherwise provided for
- A61B90/37—Surgical systems with images on a monitor during operation
- A61B2090/376—Surgical systems with images on a monitor during operation using X-rays, e.g. fluoroscopy
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
- A61B6/00—Apparatus or devices for radiation diagnosis; Apparatus or devices for radiation diagnosis combined with radiation therapy equipment
- A61B6/50—Apparatus or devices for radiation diagnosis; Apparatus or devices for radiation diagnosis combined with radiation therapy equipment specially adapted for specific body parts; specially adapted for specific clinical applications
- A61B6/504—Apparatus or devices for radiation diagnosis; Apparatus or devices for radiation diagnosis combined with radiation therapy equipment specially adapted for specific body parts; specially adapted for specific clinical applications for diagnosis of blood vessels, e.g. by angiography
Definitions
- the present disclosure relates to a method of trajectory planning for a medical robot system having a large number of degrees of freedom, wherein a pose of a first component of the robot system may be changed independently of a pose of a second component of the robot system and wherein an initial status of the robot system is determined in that for each of the degrees of freedom, an initial value is obtained.
- the disclosure also relates to a robotic apparatus having a medical robot system having a large number of degrees of freedom, the robot system having an actuator system having a large number of actuators, wherein the actuator system is configured to change a pose of a first component of the robot system independently of a pose of a second component of the robot system, and a measuring system, which is configured to measure an initial value for each of the degrees of freedom.
- the disclosure also relates to an apparatus for data processing and to a computer program.
- Conventional methods for trajectory planning calculate the distances of critical surfaces of the robot system relative to one another and then proceed iteratively. That is to say, the status of the robot system is easily changed, the changed distances are calculated again and compared with specified limit values. If one of the distances undershoots the corresponding limit value, the change in the status is thus discarded and another change in the status assumed. If the limit values are observed, the process continues starting from the changed status. This is repeated until an acceptable end status is attained.
- the path planning module has an AI component, which is trained on the basis of specified input data and a training target specification to distinguish unsafe movements of the robot from safe movements and to determine a respective path from an initial pose of the robot to a respective target.
- an X-ray diagnosis facility having a multiply motor-adjustable mount arranged on an equipment cart, on which mount a C-arm with an X-ray beam source and an X-ray beam receiver arranged opposite it is mounted so as to be manually displaceable along its circumference.
- the mount has components or devices for determining the relative position of the C-arm in respect of the mount.
- An axis controller controls the motor-driven adjustment of the mount synchronously with the manual movement of the C-arm in the mount in such a way that for a target within an examination object, a predetermined condition is met for the X-ray mapping geometry.
- a method for positioning an X-ray apparatus relative to an imaging apparatus includes: (S1) with the aid of an imaging apparatus, acquisition of an image dataset in a reference coordinate system particular to the imaging apparatus; (S2) obtaining coordinates within the image dataset and determining first items of positioning data for the X-ray apparatus in such a way that a radiograph with the X-ray apparatus, which takes into account the first items of positioning data, includes image information at the coordinates, which correspond to the coordinates within the image dataset; (S3) transferring the first items of positioning data to the X-ray apparatus; (S4) determining the position of the examination region in a reference coordinate system particular to the X-ray apparatus and determining second items of positioning data as a function of a transformation of the reference coordinate system, particular to the imaging apparatus, in that of the X-ray apparatus; and (S5) positioning the X-ray apparatus as a function of the second items of positioning data.
- the disclosure relates to basing the trajectory planning on items of position information of discrete reference points to the components of the robot system.
- a method of trajectory planning for a medical robot system having a large number of degrees of freedom has a first component and a second component, wherein a pose of the first component may be changed independently of a pose of the second component, for example, by a large number of actuators of the robot system.
- An initial status of the robot system is determined in that for each of the degrees of freedom of the large number of degrees of freedom, an initial value is obtained, (e.g., measured), in particular from or by a measuring system of the robot system.
- items of position information of at least two, in particular specified, discrete reference points of the first component in respect of one another are determined, in particular by at least one computing unit.
- further items of position information of at least two, in particular specified, discrete further reference points of the second component in respect of one another are determined, in particular by the at least one computing unit.
- a trajectory is planned for the robot system, in particular by the at least one computing unit, which transfers the robot system from the initial status into a target status, in particular a specified target status, of the robot system.
- the robot system and the at least one computing unit may be component parts of a robotic apparatus.
- a robot system may refer to a system including one or more robot(s).
- a robot may be comprehended as an apparatus, which has one or more moving part(s), which are freely movable in respect of two or more, (e.g., three or more), axes of movement, with the movement taking place automatically, for example, on the basis of corresponding programming, and possibly being limited by mechanical, dynamic, or other restrictions.
- the axes of movement may include linear axes of movement and/or axes of rotation. Each axis may be comprehended as a degree of freedom.
- a medical robot system may refer to a robot system configured to carry out a medical application. It may be systems for medical imaging, for example, X-ray-based imaging, and/or for carrying out or assisting medical interventions. For example, computed tomography systems or angiography systems, in particular systems for interventional angiography, may be configured as medical robot systems.
- the medical robot system whose trajectory is planned, has a large number of degrees of freedom, three or more degrees of freedom of axes of movement, therefore.
- At least one first degree of freedom of the large number of degrees of freedom relates to the first component, and at least one second degree of freedom of the large number of degrees of freedom to the second component.
- the entirety of the at least one first degree of freedom determines the pose of the first component and the entirety of the at least one second degree of freedom determines the pose of the second component.
- the pose may refer to the entirety of three corresponding spatial coordinates, translational positions therefore, and three corresponding orientation angles, rotatory positions, therefore. It is not necessarily possible to change all six translational and rotatory positions of the component independently or interdependently, however.
- individual translational positions and/or rotatory positions may be defined by the configuration of the respective component or by other boundary conditions.
- the pose of one of the components may also be referred to as the status of the respective component, the poses of the first and the second components together as the status of the robot system.
- the first component and the second component may belong to two different robots of the robot system, for instance a robot stand, also referred to as a robot support, and a robotic patient couch, also referred to as a patient table.
- the first component and the second component may also be part of the same robot, however.
- the pose of the first component may be changed independently of the pose of the second component.
- the pose of the first component may be changed in a given reference coordinate system and the pose of the second component may remain unchanged in the same reference coordinate system, or vice versa. This does not rule out a simultaneous change in the poses of the first component and the second component, however.
- the robot system may have an actuator system that contains the large number of actuators, (e.g., motors), and a corresponding control system for controlling the actuators.
- the poses of the first and second components may be changed independently of one another by appropriate control of the large number of actuators.
- the value, which is measured for each of the degrees of freedom, corresponds, (e.g., directly or indirectly), to the respective translational or rotatory position, which corresponds to the degree of freedom.
- the position is measured directly or may be derived from the measured value.
- the measuring system may contain corresponding sensors, for example, rotary encoder and the like, for measuring the position, for example, by way of an appropriate measurement of an actuator position or setting.
- the reference points are defined, in particular, in advance.
- the at least two reference points do not necessarily lie on a surface of the first component but are defined in respect of the first component, as stated above. At least one reference point of the at least two reference points may have a distance from the first component greater than zero, and therefore does not lie on any surface of the first component. This has the advantage that particularly relevant reference points, for example, points of symmetry or potential collision points, may be used for trajectory planning.
- the at least two further reference points do not necessarily lie on a surface of the second component but are defined in respect of the second component, as stated above. At least one reference point of the at least two further reference points may have a distance from the second component greater than zero, and therefore not lie on any surface of the second component.
- the reference points being discrete may refer to distinct points from continuous points.
- a surface in the space is given, for example, by a quantity of continuous points, each point has an infinite quantity of adjacent points, therefore, from which it has no distance.
- the at least two discrete reference points and the at least two further discrete reference points it is possible to define, in particular, a minimum distance, so any pair of points of the at least two reference points has a distance from one another, which is greater than or equal to the minimum distance, and any pair of points of the at least two further reference points has a distance from one another, which is greater than or equal to the minimum distance.
- the minimum distance for the at least two reference points may also differ from that for the at least two further reference points, however.
- the respective minimum distance may be in the order of magnitude of a few centimeters or more, for example, greater than or equal to 5 cm or greater than or equal 10 cm, or lie in the range of 5 cm to 50 cm or in the range of 10 cm to 50 cm.
- the items of position information of the at least two reference points may include the respective three-dimensional coordinates of the at least two reference points. Consequently, the position of the at least two reference points relative to one another is also defined. Alternatively, the items of position information may include only the position of the at least two reference points relative to one another. Combinations are also possible. The same applies analogously to the further items of position information of the at least two further reference points.
- the trajectory of the robot system may refer to the trajectory in the multi-dimensional space, at least three-dimensional space, which is spanned by the entirety of the large number of degrees of freedom, therefore.
- Each status of the robot system is given by exactly one point in the multi-dimensional space.
- the trajectory is a curve or hyper-curve in the multi-dimensional space, therefore, which leads from the initial status to the target status, transfers the robot system from the initial status into the target status therefore, if the actuators are actuated accordingly.
- the target status of the robot system may be calculated dependent, for example, on the initial status, the items of position information, and/or the further items of position information, in particular by the at least one computing unit.
- the target status may follow from the trajectory planning.
- the target status may be specified. Combinations of these alternatives are also possible.
- a target range may be specified for the target status and the exact target status may be calculated from the trajectory planning or as explained.
- trajectory planning By using the discrete reference points for trajectory planning, in particular distinct from approaches, which are based on the calculation of distances between surfaces, it is possible to simplify, and therewith accelerate, trajectory planning.
- selection of the reference points a limitation to the actually relevant geometric properties of the robot system is possible without a comprehensive model, in particular surface model, being required. Consequently, in particular, a trajectory planning may be implemented in which the trajectory from the initial status through to the target status is planned without iterative intermediate acts being required for collision testing, without it being necessary to check for intermediate states between the initial status through to the target status, whether a collision of the components with one another or possibly one of the components with a patient is probable.
- the method of trajectory planning disclosed herein does not include actuation of the actuators in order to actually transfer the robot system from the initial status into the target status, and therefore does not include the transfer itself. From each implementation of the method of trajectory planning, a corresponding method for controlling the medical robot system follows, however, in accordance with which the robot system is transferred along a planned trajectory from an initial status of the robot system into a target status of the robot system, with a method of trajectory planning being carried out in order to plan the trajectory for the robot system.
- the method of trajectory planning may refer to a combination of a computer-implemented method of trajectory planning with the preceding act of measuring the initial values.
- Each act of the computer-implemented method may be carried out by an apparatus for data processing, in particular at least one processor of the apparatus for data processing.
- the apparatus for data processing may be the at least one computing unit or contain the at least one computing unit.
- the robot system contains a medical imaging modality having the first component and a patient couch having the second component.
- the patient couch in particular a supporting plate of the patient couch, may be rotated or tilted or inclined, for example, about one, two, or three axes. Furthermore, the entire patient couch as a whole or the supporting plate in respect of a support component of the patient couch may be translationally moved, for example, in one, two, or three direction(s).
- the imaging modality may be configured, for example, as a C-arm system, also as a C-arm system, for medical imaging, for example, for X-ray-based imaging, in particular computed tomography, and/or X-ray-based angiography, and/or for interventional angiography.
- the C-arm system may be configured, for example, as a C-arm system mounted on the ceiling or as a mobile C-arm system.
- Robot systems with C-arm system and patient couches as described have a high number of degrees of freedom, for example, three rotatory degrees of freedom of the C-arm system, and one, two, or three rotatory degrees of freedom of the patient couch, and possibly additional translational degrees of freedom. Accordingly, the states of the robot system may be highly complex, whereby highly complex poses of the first and second components relative to one another may result. The advantages of the disclosure are particularly effective here, therefore.
- the first component corresponds to a C-arm for X-ray-based imaging, or the imaging modality has the C-arm and the first component is rigidly attached to the C-arm.
- an X-ray detector and/or an X-ray collimator may be attached to the C-arm.
- a first reference point of the at least two reference points corresponds to a center of the C-arm and a second reference point of the at least two reference points lies on an, in particular straight, line, which connects an X-ray detector of the C-arm to an X-ray collimator of the C-arm and runs through the center of the C-arm.
- the first reference point is in any case located between the X-ray detector and the X-ray collimator.
- the second reference point may lie in or on the X-ray detector or X-ray collimator.
- the trajectory for the robot system is planned dependent on a first reference vector, which points from the first reference point to the second reference point.
- this first reference vector may be sufficient to form the items of position information.
- the items of position information may include the first reference vector.
- a second reference vector which is perpendicular to the supporting plate of the patient couch, is calculated dependent on the initial status.
- An alignment of the first reference vector is controlled or regulated in respect of the second reference vector for planning the trajectory.
- a third reference vector which is parallel to the supporting plate of the patient couch, is calculated dependent on the initial status.
- An alignment of the first reference vector is controlled or regulated in respect of the third reference vector for planning the trajectory.
- the second and/or the third reference vector(s) may be regarded, in particular, as part of the further items of position information, therefore.
- the second and/or the third reference vector(s) may be calculated, in particular, dependent on the initial status and the at least two second reference points.
- the planning of the trajectory is carried out in such a way that a first angle between the second reference vector and a projection of the first reference vector is minimized in a plane perpendicular to the third reference vector, or the planning of the trajectory is carried out in such a way that a second angle between the third reference vector and a projection of the first reference vector is minimized in a plane perpendicular to the second reference vector.
- the trajectory is planned in such a way that the first angle and/or the second angle are as small as possible throughout the entire trajectory.
- one or more optimization method(s) may be carried out.
- the C-arm is mounted and/or guided in such a way that the C-arm may be orbitally rotated about a first axis of rotation and about a second axis of rotation, which is perpendicular to the first axis of rotation, with the orbital rotation about the first axis of rotation and the rotation about the second axis of rotation corresponding to mutually independent degrees of freedom of the large number of degrees of freedom.
- the orbital rotation may be comprehended, in particular, as a rotation of the C-arm within the plane defined by the C-arm. Substantially any cranial or caudal settings of the C-arm and substantially any LAO/RAO settings of the C-arm may accordingly be achieved by the orbital rotation about the first axis of rotation and the rotation about the second axis of rotation.
- LAO and RAO stand for left anterior oblique and right anterior oblique respectively.
- the trajectory is planned in such a way that a respective distance between the first reference point and each further reference point of the at least two further reference points is continuously enlarged and/or remains constant when the robot system transfers along the trajectory from the initial status into the target status.
- the respective distance between the first reference point and each further reference point is not reduced at any instant when the robot system transfers along the trajectory from the initial status into the target status.
- a collision of the components with one another and/or a collision of one of the components with a patient may consequently be avoided.
- the trajectory is planned in such a way that a respective distance between the second reference point and each further reference point of the at least two further reference points is continuously enlarged and/or remains constant when the robot system transfers along the trajectory from the initial status into the target status.
- the respective distance between the second reference point and each further reference point is not reduced at any instant when the robot system transfers along the trajectory from the initial status into the target status.
- an apparatus for data processing has at least one processor configured to carry out a computer-implemented method as disclosed herein.
- a computer-implemented method an initial status of a medical robot system is obtained, wherein a pose of a first component of the robot system may be changed independently of a pose of a second component of the robot system, in the form of measured initial values for each degree of freedom of a large number of degrees of freedom of the robot system, in particular from a measuring system of the robot system. Items of position information of at least two discrete reference points of the first component are determined in respect of one another on the basis of the initial status.
- Further items of position information of at least two discrete further reference points of the second component are determined in respect of one another on the basis of the initial status.
- a trajectory is planned for the robot system, which transfers the robot system from the initial status into a target status of the robot system, dependent on the initial status, the items of position information and the further items of position information.
- a robotic apparatus has a medical robot system having a large number of degrees of freedom.
- the robot system has an actuator system having a large number of actuators, wherein the actuator system is configured to change a pose of a first component of the robot system independently of a pose of a second component of the robot system, in particular by controlling the large number of actuators.
- the robot system has a measuring system configured to measure an initial value for each of the degrees of freedom.
- the robotic apparatus has at least one computing unit configured to carry out a method as disclosed herein in which, on the basis of an initial status given in the form of the measured initial values, items of position information of at least two discrete reference points of the first component in respect of one another are determined.
- the robot system contains a medical imaging modality having the first component and a patient couch having the second component.
- the first component corresponds to a C-arm for X-ray-based imaging or is rigidly attached to the C-arm.
- a first reference point of the at least two reference points corresponds to a center of the C-arm and a second reference point of the at least two reference points lies on an, in particular straight, line, which connects an X-ray detector of the C-arm to an X-ray collimator of the C-arm and runs through the center of the C-arm.
- the C-arm is mounted and/or guided in such a way that the C-arm may be orbitally rotated about a first axis of rotation and may be rotated about a second axis of rotation, which is perpendicular to the first axis of rotation, wherein the orbital rotation about the first axis of rotation and the rotation about the second axis of rotation correspond to mutually independent degrees of freedom of the large number of degrees of freedom.
- a robot system is configured to carry out a method of trajectory planning or carries out such a method.
- a computer program having commands is disclosed.
- the commands When the commands are executed by an apparatus for data processing, in particular an apparatus for data processing, the commands prompt the apparatus for data processing to: (1) obtain an initial status of a medical robot system, wherein a pose of a first component of the robot system may be changed independently of a pose of a second component of the robot system, in the form of measured initial values for each degree of freedom of a large number of degrees of freedom of the robot system; (2) determine items of position information of at least two discrete reference points of the first component in respect of one another on the basis of the initial status; (3) determine further items of position information of at least two discrete further reference points of the second component in respect of one another on the basis of the initial status; and (4) plan a trajectory for the robot system, which transfers the robot system from the initial status into a target status of the robot system, dependent on the initial status, the items of position information and the further items of position information.
- the commands When the commands are executed by a robotic apparatus, in particular the at least one computing unit of the robotic apparatus, the commands prompt the robotic apparatus, for example, to carry out a method of trajectory planning.
- a computer-readable storage medium which stores a computer program.
- the computer program and the computer-readable storage medium may each be comprehended as a computer program product having the commands.
- a computing unit may refer to a data processing unit that contains a processing circuit.
- the computing unit may process data for carrying out computing operations, therefore. These possibly also include operations to carry out indicated instances of access to a data structure, for example a look-up table (LUT).
- LUT look-up table
- the computing unit may include one or more computer(s), one or more microcontroller(s), and/or one or more integrated circuit(s), (e.g., one or more application-specific integrated circuit(s) (ASIC), one or more field programmable gate array(s) (FPGA), and/or one or more system(s) on a chip (SoC)).
- the computing unit may also contain one or more processor(s), (e.g., one or more microprocessor(s), one or more central processing unit(s) (CPU), one or more graphics processing unit(s) (GPU), and/or one or more signal processor(s), such as one or more digital signal processor(s) (DSP)).
- the computing unit may also include a physical or a virtual group of computers or other units.
- the computing unit includes one or more hardware and/or software interface(s) and/or one or more memory unit(s).
- a memory unit may be configured as a volatile data memory, (e.g., as a dynamic random access memory (DRAM) or static random access memory (SRAM)), or as a non-volatile data memory, (e.g., as a read-only memory (ROM), as a programmable read-only memory (PROM), as an erasable read-only memory (EPROM), as an electrically erasable read-only memory (EEPROM), as a flash memory or flash EEPROM, as a ferroelectric random access memory (FRAM), as a magneto-resistive random access memory (MRAM), or as a phase-change random access memory (PCRAM)).
- DRAM dynamic random access memory
- SRAM static random access memory
- ROM read-only memory
- PROM programmable read-only memory
- EPROM erasable read-only memory
- EEPROM electrically erasable read-only memory
- FRAM ferroelectric random access memory
- MRAM magneto-resistive random access memory
- a component of the robotic apparatus (e.g., the at least one computing unit of the robotic apparatus), is adapted, designed, configured, or the like to perform or implement a particular function, to achieve a particular effect, or to serve a particular purpose
- this may be understood in such a way that the component, beyond the basic or theoretical usability or suitability of the component for this function, effect or this purpose is specifically and actually capable of performing or implementing the function, achieving the effect or serving the purpose, by way of appropriate adjustment, programming, physical embodiment, etc.
- FIG. 1 depicts a schematic representation of an exemplary embodiment of a robotic apparatus
- FIG. 2 depicts a schematic representation of a robot stand of a further exemplary embodiment of a robotic apparatus
- FIG. 3 depicts a schematic representation of a patient couch of a further exemplary embodiment of a robotic apparatus in a side view
- FIG. 4 depicts a schematic representation of a patient couch of a further exemplary embodiment of a robotic apparatus in a plan view
- FIG. 5 depicts a schematic representation of a patient couch of a further exemplary embodiment of a robotic apparatus in a front view
- FIG. 6 depicts a schematic representation of a patient couch of a further exemplary embodiment of a robotic apparatus in a plan view
- FIG. 7 depicts a schematic representation of a patient couch of a further exemplary embodiment of a robotic apparatus in a side view.
- FIG. 8 depicts a schematic representation of a patient couch of a further exemplary embodiment of a robotic apparatus in a front view.
- FIG. 1 schematically shows an exemplary embodiment of a robotic apparatus having a robot system 1 and a computing unit 21 .
- the robot system 1 is configured as a C-arm system having a, for example mobile, robot stand 2 , which contains a C-arm 7 , and a patient couch 3 .
- the patient couch 3 has a table column 10 and a supporting plate 11 arranged on the table column 10 for a patient to lie on.
- the supporting plate 11 may be translationally moved in one, two, or three direction(s) and/or be rotated about one, two, or three axes of rotation in respect of the table column 10 .
- the robot stand 2 has a base 4 , which has a swivel joint 12 .
- a C-arm mount 5 is rotatably connected to the base 4 by a further swivel joint 6 .
- the C-arm 7 is movably attached to the C-arm mount 5 in respect of an orbital rotation of the C-arm 7 .
- the robot stand 2 has three rotatory degrees of freedom and may be configured to also move translationally, moreover.
- FIG. 2 schematically represents a robot stand 2 of a robot system 1 of a further exemplary embodiment of the robotic apparatus.
- This robot stand 2 is designed, by way of example, as a C-arm system mounted on the ceiling 13 .
- the robot system 1 has an actuator system (not represented), which contains a large number of actuators and a control unit for controlling the large number of actuators.
- the degrees of freedom of the robot stand 2 may consequently be changed independently of the degrees of freedom of the patient couch 3 , or vice versa.
- a measuring system (not represented) of the robot system 1 may measure an initial value for each of the degrees of freedom of the entire robot system 1 , for example by way of a measurement of the statuses of the large number of actuators.
- the computing unit 21 may determine items of position information of at least two discrete reference points 19 a , 19 b , 19 c , 19 d of the robot stand 2 in respect of one another further items of position information of at least two discrete further reference points 20 a , 20 b , 20 v , 20 d , 20 e , 20 f (see for example FIG. 4 ) of the patient couch 3 in respect of one another.
- the computing unit 21 may plan a trajectory for the robot system 1 , which transfers the robot system 1 from the initial status into a target status.
- a concept for carrying out collision-avoiding and safe robot movements in the three-dimensional space may be implemented.
- Different algorithms, which use one or more sub-robotic movement strategies, may be derived from this concept.
- the concept is suitable for use in medical robotics, for example, in interventional angiography.
- the application of the concept is not restricted to the field of medical robotics, however, but may be used in many fields of robotics to achieve high-level path planning of robots.
- a robot system 1 mounted on the ceiling 13 , for interventional angiography is assumed below. The same concept may also be applied to other angiography or imaging robots, however.
- the robot system 1 contains a robot stand 2 and a patient couch 3 .
- FIG. 2 shows the robot stand 2 in a side view.
- a C-arm 7 of the robot stand 2 has a detector 9 , in particular X-ray detector, at the upper end of the C-arm 7 and a collimator 8 and/or an X-ray source at the lower end of the C-arm 7 .
- the robot stand 2 may be positioned in many different alignments, for example, so the desired angular position of the X-ray beam from the collimator 8 to the detector 9 may be achieved. As a rule, the X-ray beam passes through the body of a patient, making a different view of the body of the patient possible in each angular position.
- the robot stand 2 has, in particular, a main arm 18 , which is attached to the ceiling 13 by a rotatable connector 14 .
- the main arm 18 and the entire robot stand 2 may move along the y-axis, which is parallel to the ceiling 13 .
- a reference point along the y-axis is selected and the movement of the robot stand 2 is measured starting from this reference point.
- RLMY designates the position of the robot stand 2 along the y-axis.
- the main arm 18 and the entire robot stand 2 may rotate about the z-axis, which is perpendicular to the ceiling 13 , in particular the rotatable connector 14 . Viewed along the z-axis, the robot stand 2 may be rotated either clockwise or counterclockwise about the z-axis.
- An intermediate arm 16 is attached to the main arm 18 by a rotatable connector 15 .
- the C-arm 7 is attached to the intermediate arm 16 by a slide 17 .
- the angular position of the robot stand 2 about the z-axis is designated RRMZ.
- the position RRMZ reflects, in particular, the angular position of a motor for rotation about the z-axis, which is arranged, in particular, on the connector 14 . It may be determined, for example, by an appropriate rotary encoder.
- the C-arm 7 may be rotated on the connector 15 , together with the intermediate arm 16 , about the y-axis, with the main arm 18 remaining fixed.
- An appropriate motor is arranged on the connector 15 , in particular.
- the position RRMY reflects, in particular, the angular position of this motor for rotation about the y-axis. It may be determined, for example, by an appropriate rotary encoder.
- the C-arm 7 is attached to the intermediate arm 16 by the slide 17 such that it may slide, independently of the rotational movement about the y-axis, along the intermediate arm 16 , so a rotation about the x-axis results, which is also referred to as an orbital rotational movement of the C-arm 7 .
- This orbital rotational movement of the C-arm 7 may be carried out independently of a movement of the intermediate arm 16 and/or of the main arm 18 .
- the orbital rotation may also be carried out by a motor, which is arranged at a connection of the intermediate arm 16 to the C-arm 7 .
- the position RRMX reflects, in particular, the angle of this motor for rotation about the x-axis. It may be determined, for example, by an appropriate rotary encoder.
- FIG. 3 represents a side view of the patient couch 3 , also referred to as a patient table, having a supporting plate 11 on which a patient may be placed and which may also be referred to as a tabletop.
- the supporting plate 11 is supported by a table column 10 .
- the patient couch 3 may, analogously to RLMY, execute a longitudinal movement along the y-axis, with only the supporting plate 11 being moved, not the table column 10 .
- TLMY designates the position of the supporting plate 11 in respect of a corresponding reference position. Furthermore, the supporting plate 11 may be moved along an x-axis and a z-axis. The corresponding positions are designated TTMX and TVMZ, respectively.
- the rotation of the supporting plate 11 z-axis is given by the position TRMZ, which corresponds to the angular position of an appropriate motor and may be determined by an associated rotary encoder. This movement may also be referred to as table rotation.
- the rotation of the supporting plate 11 y-axis is given by the position TRMY, which corresponds to the angular position of an appropriate motor and may be determined by an associated rotary encoder. This movement may also be referred to as rocking movement.
- the rotation of the supporting plate 11 x-axis is given by the position TRMX, which corresponds to the angular position of an appropriate motor and may be determined by an associated rotary encoder. This movement may also be referred to as table inclination.
- the instantaneous status of the robot stand 2 given by RLMY, RRMZ, RRMY, RRMX
- the instantaneous status of the patient couch 3 given by TLMY, TTMX, TVMZ, TRMZ, TRMY, TRMX, and possibly dimensions of the robot stand 2 and dimensions of the patient couch 3
- TLMY, TTMX, TVMZ, TRMZ, TRMY, TRMX, and possibly dimensions of the robot stand 2 and dimensions of the patient couch 3 may be comprehended as direct input data, as data, which may be directly measured or may be determined without further data processing being necessary, therefore.
- Mechanical parameters of the robot system 1 , boundary points of robot arms or motors may also be direct input data.
- Derived input data may be data that cannot be directly measured or is not directly available and therefore a certain processing effort is required to make it available.
- Such data may be discrete spatial reference points, which represent the current position of the robot stand 2 and/or the patient couch 3 .
- Such a discrete reference point may be situated at any location of the robot stand 2 or the patient couch 3 and may be derived from the instantaneous status of the robot system 1 , the instantaneous status of the robot stand 2 and the instantaneous status of the patient couch 3 , therefore.
- FIG. 2 represents four exemplary reference points 19 a , 19 b , 19 c , 19 d of the robot stand 2 .
- the reference point 19 a is, for example, a required reference point in the center of the C-arm 7 .
- Two further reference points 19 b , 19 c are arranged above or below the collimator 8 .
- One of the two reference points 19 b , 19 c may likewise be required, whereas the second may be optional.
- a further optional reference point 19 d is situated, for example, on the C-arm 7 or the slide 17 .
- the reference points 19 a , 19 b , 19 c , 19 d may be linked together to obtain three-dimensional vectors. These vectors help to generate a clear understanding of the position of the robot stand 2 . How these vectors may be used for position control of the robot system 1 will be described further below. If required, further reference points may be added to the robot stand to create more robust position control conditions.
- FIG. 4 and FIG. 5 represent exemplary reference points 20 a , 20 b , 20 c , 20 d , 20 e , 20 f , 20 g of the patient couch 3 .
- the reference points 20 a , 20 b , 20 c , 20 d are situated, for example, at the four corners of the supporting plate 11 .
- the optional reference points 20 e , 20 f may be situated, for example, centrally on the short sides of the supporting plate 11 .
- the reference point 20 g is situated, for example, centrally in the table column 10 .
- the reference points 20 a , 20 b , 20 c , 20 d , 20 e , 20 f , 20 g may be linked together to obtain three-dimensional vectors. These vectors help to generate a clear understanding of the position of the patient couch 3 . How these vectors may be used for position control of the robot system 1 will be described further below.
- Medical methods may require different setting options for the angiographic robot system 1 .
- the robot stand 2 and the patient couch 3 may be freely aligned to achieve the desired LAO and cranial setting.
- robot stand 2 and patient couch 3 may be interlocked in many different combinations. That is to say, it is difficult to resolve the position manually such that the patient is easily accessible, for example for a doctor.
- the number of combinations is potentially so high that, owing to the computing power required for conventional model-based automatic path planning algorithms, it may be regarded as almost infinite.
- the present concept enables the movement of the robot stand 2 and the patient couch 3 to be automatically brought from any initial status into a target status in which robot stand 2 and the patient couch 3 are no longer interlocked.
- the corresponding algorithm may be referred to as a complex position resolver.
- a generic method is disclosed, which covers all clinically relevant positions and maximizes the coverage beyond the clinically relevant positions.
- a movement pattern of the robot system 1 which may be regarded as safe, is achieved.
- a movement pattern of the robot system 1 which actively maximizes the distance between patient and robot system 1 , is achieved.
- a movement pattern which is consistent throughout the entire life of the robot system 1 , is achieved. This means that the robot system 1 for given initial status and target status the same trajectory results.
- a deterministic robot movement is achieved. This means that, using the current position, a person may predict how the robot system 1 will move.
- reaction time is achieved, if it is possible on the basis of the hardware and/or system specifications.
- the planning time is independent of the initial status of the robot system 1 .
- the complex position resolver may be comprehended as a robotic movement strategy, which is composed of robotic sub-movement strategies.
- the sub-movement strategies make control of the following movements possible, for example: cranial/caudal movement; LAO/RAO movement; cranial/caudal movement with minimal or no change in the LAO/RAO position; and/or shifting of the patient couch 3 into a safe status, at which the risk of a collision of the patient and/or the patient couch 3 with the robot stand is minimized.
- values for LAO/RAO may be ascertained, which minimize the risk of collisions with the patient or bruising of the patient.
- An emergency situation may occur during interventional angiography or another procedure.
- a doctor may have to carry out cardiopulmonary resuscitation (CPR) on the patient.
- CPR cardiopulmonary resuscitation
- Such emergencies are highly time-critical, and the doctor requires access to the patient as quickly as possible to be able to carry out CPR.
- the situation may occur where the robot system 1 is interlocked in such a complex way that the patient may no longer be reached.
- the status of the robot system 1 may be so complex that manual repositioning of the robot system 1 , to obtain access to the patient, requires a lot of time. In such cases, faster automatic repositioning of the robot system 1 into a status in which access to the patient is possible, may save a lot of time. If such an automatic movement may be carried out reliably and quickly, the doctor has to give the robot system 1 just one corresponding command. If the automatic movements are deterministic, moreover, an experienced doctor may even begin preparing for CPR while the robot system 1 is being repositioned.
- the following sequence of partial strategies for faster repositioning of a robot system 1 may be used to obtain access to the patient: (1) Longitudinal movement of the patient couch 3 along the y-axis; (2) Cranial movement with minimal or no change in the LAO; (3) Bringing the patient couch 3 into a safe status in which the risk of a collision is minimized; (4) LAO movement for minimal risk of bruising/collision to the patient; (5) Vertical movement of the patient couch 3 along the z-axis; (6) Transversal movement of the patient couch 3 along the x-axis; (7) LAO movement; (8) Vertical movement of the patient couch 3 along the z-axis; (9) Rotational movement of the patient couch 3 about the x-axis; (10) Rotational movement of the patient couch 3 about the y-axis; (11) Longitudinal movement of the robot stand 2 along the y-axis.
- This course of movement may be executed as required or depending on desired quality and safety goals, either simultaneously, partially simultaneously, or successively, in particular in the order.
- the robot system 1 may be brought quickly from any complex status into a status in which access to the patient is possible.
- the complex position resolver may require geometric input data, in particular direct and derived input data.
- the complex position resolver may use derived input data to generate additional input data, as will be explained below.
- FIG. 2 shows a vector, which points from the reference point 19 a to the reference point 19 b or to the reference point 19 c .
- This vector will be referred to below as the C-arm vector-of-interest, CVOI for short.
- the complex position resolver may have, for example, the following sections: (1) Dual plane vector controller; (2) Mono plane controller; (3) Patient couch relocalizer; (4) Robot stand forward kinematics; (5) Robot stand optimum solution identifier; and/or (6) Patient couch point-of-interest calculator.
- the dual plane vector controller controls the alignment of the CVOI. This is controlled by two different strategies: mono-rotation control and dual-rotation control.
- Mono-rotation control controls the alignment of the CVOI in the x-y-plane. Changes, which are caused in other planes due to the alignment control in the x-y-plane, are not taken into account in this case.
- This control of the angle of the CVOI is visualized in FIG. 6 .
- the plan view of the patient couch 3 or the supporting plate 11 may be seen on the left.
- a vector (arrow with dotted line in FIG. 6 ) is calculated, which is perpendicular to the patient couch 3 .
- the direction of this vector is determined on the basis of the alignment of the collimator 8 in the x-y-plane in relation to the supporting plate 11 .
- FIG. 6 shows the plan view of the reference coordinate system of the robot stand 2 .
- the vector perpendicular to the patient couch 3 is transformed from the reference coordinate system of the patient couch 3 into reference coordinate system of the robot stand 2 .
- the angle between the CVOI (arrow with solid line, on the right in FIG. 6 ) and the vector perpendicular to the patient couch 3 is controlled. The aim is to keep this angle as close as possible to 0.
- the angle of the CVOI in the x-y-plane is to be ascertained by way of this section and the CVOI set perpendicular to the patient couch 3 .
- This section is only activated, in particular, if particular specified safety criteria are met, as will be explained below.
- the section “dual rotation control of the algorithm” controls the alignment of the CVOI in the y-z-plane and may correct or take into account possible changes, which are caused in the x-z-plane by the alignment control in the y-z-plane.
- FIG. 7 schematically represents the angular control. On the left, FIG. 7 shows the inclined supporting plate 11 , TRMX therefore.
- the vector perpendicular to the supporting plate 11 (arrow with dotted line in FIG. 7 ) is generated and its effective impact in the 3-dimensional space is calculated.
- the corresponding effective impact is applied to CVOI, the remaining difference between the vector perpendicular to the supporting plate 11 and the CVOI is controlled.
- the angle of the CVOI in the y-z-plane is to be ascertained by way of this section and the CVOI aligned perpendicular to the supporting plate 11 , while the impacts in the x-z-plane are minimized.
- the angle of the CVOI in the x-z-plane may remain the same or change only minimally.
- This section is, in particular, always active.
- the section “mono plane controller of the algorithm” controls the alignment of the CVOI in the x-z-plane. This alignment of the CVOI is controlled, for example, by two different strategies: patient couch-dependent control and patient couch-independent control.
- FIG. 8 schematically represents the control of the angle. On the left, FIG. 8 shows the front view of the patient couch 3 , with it being possible to see TRMY. The vector perpendicular to the supporting plate 11 (arrow with dotted line in FIG.
- the angle of the CVOI in the x-z-plane is ascertained and the CVOI in the x-z-plane is aligned with this angle by way of this section, while the alignment of the CVOI in the y-z- and x-y-planes is kept at the desired value.
- This section is, for example, always active.
- the alignment of the CVOI in the x-z-plane is controlled independently of the current position of the patient couch 3 .
- the angle of the CVOI in the x-z-plane is ascertained, which minimizes the risk of bruising and/or collision for the patient and enlarges the scope for movement of the patient couch 3 .
- the angle of the CVOI in the x-z-plane is ascertained and the CVOI aligned with this angle in the x-z-plane by way of this section, while the alignment of the CVOI in the y-z- and x-z-planes is kept at the desired value.
- This section is, for example, always active.
- the section “patient couch relocalizer” controls TTMX and TVMZ of the patient couch 3 . It uses the point-of-interest information of the patient couch 3 and the information relating to CVOI to ascertain the required displacement of the patient couch 3 in the TTMX and TVMZ directions. In other words, the patient couch 3 is displaced such that the point-of-interest moves as far as possible in the direction of the origin of the CVOI, in particular of the reference point 19 a therefore, with the instantaneous position of the robot stand 2 being taken into account.
- This section is only activated, for example, if particular criteria are met, as explained below.
- the section “patient couch point-of-interest calculator” uses the available information about CVOI to calculate the above-mentioned point on the patient couch 3 , which is referred to as the point-of-interest of the patient couch 3 .
- the point-of-interest may be regarded as additional information, which is generated on the basis of the derived data and the instantaneous position of the robot stand 2 .
- Other sections of the complex position resolver may use the point-of-interest to bring the patient couch 3 into a position, which is safer and provides a lower risk of collision, and/or to ascertain the desired angle of alignment of the CVOI in the x-z-plane.
- the section “robot stand forward kinematics” supplies the items of position information of the robot stand 2 .
- this section finds the corresponding values for CVOI, which represent the given values for RRMY, RRMZ, and RRMX or for the given values of RRMZ and RRMX, and the angles of CVOI in the x-z-plane and in the y-z-plane.
- the section “robot stand optimum solution identifier” calculates the optimum RRMY, and RRMX values of the robot stand 2 for given RRMZ and CVOI.
- this section supplies information about the integrity of the optimum values for RRMY and RRMX.
- the specified RRMY and RRMX values may be limited owing to mechanical restrictions, so the CVOI may not be achieved.
- this section returns the best possible RRMY and RRMX values, which are closest to the given CVOI with given RRMZ. This part of the algorithm may be freely adjusted, as required, to find an optimum solution.
- the implementation of this section for CPR concentrates on the provision of a solution, which is close to the current RRMX and RRMY values of the robot stand 2 and indicates a reduced or minimized risk of collision.
- the section “robot stand optimum solution identifier” supplies the positions RRMY, RRMX, which represent a given CVOI with a given RRMZ. It covers information about how CVOI and RRMZ are used to determine RRMY, RRMX, which represent the given CVOI.
- the CVOI provided to this section as an input is influenced by the RRMZ rotation of the robot stand 2 .
- CVOI may be rotated about the z-axis in that the value exactly opposite the RRMZ position is specified.
- the vector-of-interest aligned with the z-direction results from this and is referred to as VOIzA.
- the length of the projection of VOIzA in the x-z-plane is shorter than a specified limit value, it may be safer and more reliable to return the current RRMY value of the robot stand to prevent RRMY movement of the robot stand 2 .
- the decision about how the algorithm may react in this case may be made as necessary.
- the coordinates of VOIzA are referred to as VOIzAx, VOIzAy, and VOIzAz.
- L 3 D ⁇ square root over (VOIzA x 2 +VOIzA y 2 +VOIzA z 2 ) ⁇
- L 2 D ⁇ square root over (VOIzA x 2 +VOIzA z 2 ) ⁇
- LL L 3 D *cos( ⁇ )
- RRMY may be ascertained, for example by the following method.
- the angle ⁇ xz of VOIzA in the x-z-plane is calculated:
- RRMY is measured starting from a fixed reference, ⁇ xz is used, and the absolute angle of VOIzA in the x-z-plane is measured.
- the measured absolute angle is the value of RRMY.
- RRMY is a rotational movement, however, that is to say, the value of RRMY may be obtained in the system by a rotation clockwise and a rotation counterclockwise. This means that there are two solutions for RRMY. If one solution is ⁇ , the other is ⁇ 360.
- restrictions may be applied to select the most suitable solution.
- the aim is to reach the target quicker and with minimal movement of the robot stand 2 .
- a condition may be added, which measures the required movement of the robot stand 2 from the instantaneous RRMY value to each available solution of RRMY.
- the solution, which comes closest to the instantaneous RRMY, is selected as the optimum RRMY solution.
- RRMX may be obtained by the following method, for example.
- VOIzA is aligned in respect of the z-axis, but not necessarily in respect of the x-axis. Because the obtained value of RRMY represents the angle of VOIzA in the x-z-plane, VOIzA is rotated about the y-axis by the value RRMY to align VOIzA with the x-axis, too.
- the resulting vector, which is aligned in relation to the z-axis and the x-axis, is referred to as VOIzxA.
- the angle ⁇ yz of VOIzxA in the y-z-plane is determined:
- Fyz VOIzxAy L ⁇ 2 ⁇ D
- ⁇ ⁇ yz cos - 1 ( ⁇ " ⁇ [LeftBracketingBar]” Fyz ⁇ " ⁇ [RightBracketingBar]” ) .
- RRMX is measured starting from a fixed reference, ⁇ yz is used, and the absolute angle of VOIzxA in the y-z-plane is measured.
- RRMX may therefore be determined such that it comes closest to the current RRMX position of the robot stand 2 .
- the obtained solution may be regarded as the optimum RRMX solution.
- Dynamic limits are, for example, limits, which may be imposed on the robot stand 2 to minimize the risk of bruising and/or collisions. These restrictions are dependent on the mechanics of a specific robot system 1 .
- the mechanical position limits of the robot stand 2 RRMY, RRMX may be ascertained from the direct input data.
- the maximum and minimum mechanical position limits for RRMY are MLYMax and MLYMin, respectively.
- the maximum and minimum mechanical position limitations for RRMX are MLXMax and MLXMin, respectively.
- MLYMax 180°
- MLYMin ⁇ 150°
- MLXMax 100°
- MLXMin ⁇ 100°.
- the C-arm 7 of a system mounted on the ceiling may be positioned around the patient couch 3 in many ways. Some positions are so complex that when a movement of the robot stand 2 within the entire range of the mechanical limits is permitted, the risk of collisions or bruising may exist. For such positions, soft limitations may be applied in addition to the mechanical limitations. If the robot stand 2 is situated on the left or right side patient couch 3 , the RRMY movement may be restricted by soft limitations, which depend on the mechanical construction of the system mounted on the ceiling. Similarly, the RRMX movement may be restricted by a soft limitation if the robot stand 2 is situated on the patient couch 3 . With a system mounted on the ceiling, the motors and arms, which control RRMY and RRMX, may also be moved with RRMZ. In other words, the soft limitation that may apply to RRMY and RRMX depends on the RRMZ position of the robot stand. This may be used to derive the dynamic limits of the system.
- RRMY maximum and minimum limit values may be defined for RRMY, RRMX, which are independent of the position of the robot stand 2 . These limit values are relative and are measured from the start or end of the quadrant in which the robot stand 2 is currently situated.
- the dynamic limits of the robot stand 2 RRMY, RRMX may thus be ascertained as follows, for example.
- Limit value checks and changes/saturations of RRMY and RRMX may be performed on the basis of these mechanical and dynamic limit values. If, for example, RRMY solution>DLYMax, then the RRMY solution may be limited to the corresponding quadrant, so the RRMY solution does not depart from the range of the soft limitation. If, for example, RRMY solution ⁇ DLYMin, then the RRMY solution may be limited to the corresponding quadrant, so the RRMY solution does not depart from the range of the soft limitation. If, for example, RRMY solution>MLYMax, then the RRMY solution may be limited to MLYMax. If, for example, RRMY solution ⁇ MLYMin, then the RRMY solution may be limited to MLYMin.
- the section “patient couch point-of-interest calculator” supplies a spatial point on the patient couch 3 as a function of the instantaneous position of the robot stand 2 .
- This spatial point which may be referred to as a point-of-interest of the patient couch 3 , permanently connects the table to the robot stand 2 in the 3-dimensional space.
- the point-of-interest may be calculated as follows.
- the CVOIy value is used in this straight line equation, so the x-coordinate TPOIx of the point-of-interest TPOI is obtained.
- TPOIy CVOIy
- the coordinates of CVOI and the reference points 20 a , 20 b , 20 c , 20 d , 20 e , and/or 20 f are to be used for calculation in the same coordinate system, corresponding coordinate transformations are carried out, therefore.
- the section “patient couch relocalizer” uses the TPOI to move the patient couch 3 as a function of the position of the robot stand 2 to a safe location. It is calculated by how much TPOI TTMX and TVMZ directions it is possible to move, in order to prevent a collision with the robot stand 2 .
- the final TTMX and TVMZ position of the patient couch 3 may be calculated as follows.
- the total displacement is limited by the current position of the robot stand 2 .
- the permissible relocalization may be ascertained as follows.
- the section “mono rotation control” orients CVOI in the x-y-plane such that, viewed from the z-axis, it is perpendicular to the supporting plate 11 . It calculates the position RRMZ in order to achieve this alignment of the CVOI.
- This section is selectively activated, for example, when particular criteria are met. These criteria may be determined as follows.
- TTMX range end two
- REO and RET are two limitations for TTMX with given CVOIy.
- the section “mono rotation control” is, for example, not activated. Otherwise, the following method is carried out for calculation of the RRMZ position.
- CVOI is displaced in the same origin, so CVOI and LP go through the same origin and in general run along any directions.
- a triangle is formed if the open end points of CVOI and LP are joined. In order to form a triangle, the open ends of CVOI and LP are joined therefore by a line LC. Because the coordinates of the CVOI end point and of the LP end point are already known, the length of the LC may be ascertained.
- the angle ⁇ between CVOI and LP is calculated with the aid of the following formula:
- ⁇ By ⁇ , the alignment of LP and the alignment of CVOI in the x-y-plane a suitable reference point for changing ⁇ is ascertained and the direction of rotation determined to align the vector CVOI with LP. After selection of the direction of rotation and the change in a, a may possibly be restricted further according to specified criteria.
- Additional safety conditions may also be added to restrict the final RRMZ value.
- particular positions may be limited by applying dynamic and mechanical limit values to reduce risks of collision.
- the following data for the current position of the robot stand 2 may be ascertained by the forward kinematics of the robot stand 2 :
- CVOI which represent given RRMY, RRMZ and RRMX values: CVOI.
- CVOI which represent given RRMZ and RRMX values, aligned with the y-axis: VOIyA.
- This section may be used to displace CVOI such that the desired angle is produced in the y-z-plane, while the existing angle in the x-z-plane is retained. This may be achieved as follows.
- the desired angle of the CVOI in the y-z-plane is ⁇ d.
- the actual angle of the CVOI in the y-z-plane dependent on the position of the patient couch 3 TRMX, TRMZ is ⁇ .
- TRMX is the actual value of the inclination about the x-axis
- TRMZ the actual value of the rotation about the z-axis
- Ftrm x cos( ⁇ )
- Ftrm z sin( ⁇ ).
- VOIyA When ⁇ x is calculated, the following operations may be carried out an VOIyA to align it as desired.
- VOIyA is rotated about the x-axis by ⁇ x and about the y-axis by ⁇ .
- the resulting vector is aligned in the y-z-plane as desired, with the existing alignment in the x-z-plane being retained.
- the resulting vector and the current position of RRMZ, RRMY and RRMX are input into the section “robot stand optimum solution identifier.” This returns the position of RRMY and RRMX, which represents the position of the robot stand 2 in order to achieve the desired VOIyA alignment.
- the situation may occur where the values of RRMY and RRMX are saturated up to the maximum achievable solution in the case of mechanical or dynamic limit values.
- the patient couch-dependent control of the section “mono plane controller” aligns CVOI in the x-z-plane by the instantaneous position of the patient couch 3 .
- the positions RRMX and RRMY are output, which represent the aligned CVOI.
- the following data for the current position of the robot stand 2 is ascertained by the forward kinematics of the robot stand 2 :
- CVOI which represent given RRMY, RRMZ and RRMX values: CVOI.
- CVOI which represent given RRMZ and RRMX values, aligned with the y-axis: VOIyA.
- ⁇ ax and ⁇ az may be determined as explained above.
- desired angle of alignment ⁇ d of CVOI in the x-z-plane are determined, for example, as follows:
- ⁇ ⁇ d ⁇ MLYMin , ⁇ ⁇ 0 MLYMax , ⁇ > 0
- ⁇ ⁇ d ⁇ - 89.99 , ⁇ ⁇ 0 89.99 , ⁇ > 0
- the desired angle of alignment is now known, the following method may be carried out to derive the RRMX and RRMY positions.
- the actual CVOI angle in the x-z-plane dependent on the TRMY position of the patient table is ⁇ .
- CVOI is rotated about the y-axis by ⁇ y.
- the desired angle of alignment in CVOI is obtained as a result.
- the change in the x-z-alignment may result in a change in the alignment of the CVOI in the y-z-plane, however. Accordingly, CVOI may be re-aligned in the y-z-plane, with the alignment in the x-z-plane remaining the same.
- the re-calculated RRMY and RRMX positions and the current RRMZ position at the section “dual rotation control” are given for this. This brings about the alignment in the y-z-plane and supplies the RRMX and RRMY positions.
- RRMX and RRMY are the desired values in order to position the robot stand 2 at the location at which CVOI is aligned in the system as desired.
- the situation may occur where the values of RRMY and RRMX are saturated up to the maximum achievable solution in the case of mechanical or dynamic limit values.
- the patient couch-independent control of the section “mono plane controller” is similar to the section patient table-dependent control.
- the sole difference is that the point-of-interest is not used for determining the angle ⁇ d.
- an approach as follows, for example, is used:
Landscapes
- Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Engineering & Computer Science (AREA)
- Medical Informatics (AREA)
- Surgery (AREA)
- Biomedical Technology (AREA)
- Public Health (AREA)
- General Health & Medical Sciences (AREA)
- Veterinary Medicine (AREA)
- Animal Behavior & Ethology (AREA)
- Heart & Thoracic Surgery (AREA)
- Molecular Biology (AREA)
- Nuclear Medicine, Radiotherapy & Molecular Imaging (AREA)
- High Energy & Nuclear Physics (AREA)
- Physics & Mathematics (AREA)
- Biophysics (AREA)
- Optics & Photonics (AREA)
- Pathology (AREA)
- Radiology & Medical Imaging (AREA)
- Robotics (AREA)
- General Business, Economics & Management (AREA)
- Epidemiology (AREA)
- Mechanical Engineering (AREA)
- Business, Economics & Management (AREA)
- Primary Health Care (AREA)
- Manipulator (AREA)
Abstract
Description
L3D=√{square root over (VOIzAx 2+VOIzAy 2+VOIzAz 2)},
and the length of the projection of the VOIzA in the x-z-plane,
L2D=√{square root over (VOIzAx 2+VOIzAz 2)},
are calculated and the minimum length of the projection of VOIzA in the x-z-plane,
LL=L3D*cos(Ø),
is determined, with Ø being the angle, which is used for selection of the minimum length. The value of Ø may be selected as necessary on the basis of the possibilities of the system, for example 89°.
L2D=VOIzxAy 2+VOIzxAz 2.
Δmax=(MLYMax−ILYMax)*Frrmy,
DLYMax=ILYMax+|Δmax|,
Δmin=(MLYMin−ILYMin)*Frrmy,
DLYMax=ILYMin+|Δmin|.
Δmax=(MLXMax−ILXMax)*Frrmx,
DLXMax=ILXMax+|Δmax|,
MLXMax=−MLXMin,
ILXMax=−ILXMin,
DLXMin=−DLXmax.
Δtx=TPOIx−OCVOIx,
Δtz=TPOIz−OCVOIz.
SDFx=sin2(Ø),
and the safe displacement factor in the TVMZ direction is given by:
SDFz=cos2(Ø)
where Ø is the angle of projection of CVOI in the x-z-plane and where CVOI represents the current position of the robot stand.
Δax=Δtx*SDFx
Δaz=Δtz*SDFz
-
- CVOI angle in the y-z-plane: α.
- CVOI angle in the x-z-plane: γ.
β=α−(Ftrmx*TRMX)+(Ftrmz*TRMZ).
Ftrmx=cos(γ),
Ftrmz=sin(γ).
-
- CVOI angle in the y-z-plane: α.
- CVOI angle in the x-z-plane: γ.
θd=0.01°.
where β=γ.
Claims (6)
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| DE102022201952.0A DE102022201952B3 (en) | 2022-02-25 | 2022-02-25 | Trajectory planning for a medical robot system |
| DE102022201952.0 | 2022-02-25 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| US20230270501A1 US20230270501A1 (en) | 2023-08-31 |
| US11877805B2 true US11877805B2 (en) | 2024-01-23 |
Family
ID=86606092
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| US18/110,071 Active US11877805B2 (en) | 2022-02-25 | 2023-02-15 | Trajectory planning for a medical robot system |
Country Status (3)
| Country | Link |
|---|---|
| US (1) | US11877805B2 (en) |
| CN (1) | CN116649992B (en) |
| DE (1) | DE102022201952B3 (en) |
Families Citing this family (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| USD1073943S1 (en) * | 2020-11-25 | 2025-05-06 | GE Precision Healthcare LLC | Imaging apparatus |
| USD1031989S1 (en) * | 2021-11-05 | 2024-06-18 | Siemens Healthineers Ag | Medical imaging device |
| USD1018855S1 (en) * | 2021-11-29 | 2024-03-19 | Siemens Healthcare Gmbh | Medical imaging device |
| USD1079947S1 (en) * | 2022-02-25 | 2025-06-17 | Siemens Healthineers Ag | Medical imaging device |
| USD1073944S1 (en) * | 2022-04-13 | 2025-05-06 | Siemens Healthineers Ag | Medical imaging device |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE10153787B4 (en) | 2001-10-31 | 2005-04-14 | Ziehm Imaging Gmbh | Mobile surgical X-ray diagnostic device with a C-arm |
| US20090274271A1 (en) * | 2008-05-02 | 2009-11-05 | Siemens Medical Solutions Usa, Inc. | System and method for selecting a guidance mode for performing a percutaneous procedure |
| DE102012200686A1 (en) | 2012-01-18 | 2013-01-24 | Siemens Aktiengesellschaft | Method for positioning X-ray device, involves acquiring image data set by imaging device, where image data set has examination area of examination object, and coordinates are obtained inside image data set for determining positioning data |
| US9398675B2 (en) * | 2009-03-20 | 2016-07-19 | Orthoscan, Inc. | Mobile imaging apparatus |
| US20180008217A1 (en) * | 2016-07-08 | 2018-01-11 | Alexander Gemmel | Motion controllers for mobile x-ray devices |
| EP3693137A1 (en) | 2019-02-05 | 2020-08-12 | Siemens Healthcare GmbH | Method for producing a path planning module and for operating a robot, path planning module and robot |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| NL8800614A (en) * | 1988-03-14 | 1989-10-02 | Philips Nv | ROENTGEN RESEARCH DEVICE WITH THREE ROTATION AXLES. |
| FR2705223A1 (en) * | 1993-05-13 | 1994-11-25 | Ge Medical Syst Sa | Method for acquiring images of a body by rotational placement |
| BR112012007654A8 (en) * | 2009-10-06 | 2017-10-10 | Koninklijke Philips Electronics Nv | VIEWING ANGLES OF THE AUTOMATED C-ARM FOR THE TREATMENT OF STRUCTURAL HEART DISEASE |
| DE202018003975U1 (en) * | 2018-08-25 | 2018-09-26 | Ziehm Imaging Gmbh | C-arm X-ray diagnostic system for taking a scan of an object with a focus trajectory with one rotational and two translatory sections |
| CN109157237A (en) * | 2018-10-17 | 2019-01-08 | 北京唯迈医疗设备有限公司 | A kind of C-arm control system and control method |
-
2022
- 2022-02-25 DE DE102022201952.0A patent/DE102022201952B3/en active Active
-
2023
- 2023-02-15 US US18/110,071 patent/US11877805B2/en active Active
- 2023-02-23 CN CN202310173673.6A patent/CN116649992B/en active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| DE10153787B4 (en) | 2001-10-31 | 2005-04-14 | Ziehm Imaging Gmbh | Mobile surgical X-ray diagnostic device with a C-arm |
| US20090274271A1 (en) * | 2008-05-02 | 2009-11-05 | Siemens Medical Solutions Usa, Inc. | System and method for selecting a guidance mode for performing a percutaneous procedure |
| US9398675B2 (en) * | 2009-03-20 | 2016-07-19 | Orthoscan, Inc. | Mobile imaging apparatus |
| DE102012200686A1 (en) | 2012-01-18 | 2013-01-24 | Siemens Aktiengesellschaft | Method for positioning X-ray device, involves acquiring image data set by imaging device, where image data set has examination area of examination object, and coordinates are obtained inside image data set for determining positioning data |
| US20180008217A1 (en) * | 2016-07-08 | 2018-01-11 | Alexander Gemmel | Motion controllers for mobile x-ray devices |
| EP3693137A1 (en) | 2019-02-05 | 2020-08-12 | Siemens Healthcare GmbH | Method for producing a path planning module and for operating a robot, path planning module and robot |
Also Published As
| Publication number | Publication date |
|---|---|
| CN116649992B (en) | 2024-07-05 |
| DE102022201952B3 (en) | 2023-06-22 |
| CN116649992A (en) | 2023-08-29 |
| US20230270501A1 (en) | 2023-08-31 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US11877805B2 (en) | Trajectory planning for a medical robot system | |
| US6702804B1 (en) | Method for safely and efficiently navigating magnetic devices in the body | |
| JP2023520602A (en) | Two-dimensional medical image-based spinal surgery planning apparatus and method | |
| KR102114089B1 (en) | Laser projection apparatus and control method thereof, laser guidance system including the apparatus | |
| JP2018512056A (en) | Apparatus and method for balancing axes of X-ray scanner gantry and maintaining user selected position | |
| CN104799933A (en) | Movement compensation method of surgical robot for positioning and guiding for bone surgery | |
| CN109674518A (en) | A kind of CT guidance auxiliary positioning sting device | |
| CN116322594A (en) | Systems and methods for determining and maintaining a center of rotation | |
| CN117084798B (en) | Puncture control method, device, computer equipment, storage medium | |
| CN117084790B (en) | Puncture azimuth control method and device, computer equipment and storage medium | |
| JP2023142507A (en) | X-ray imaging equipment and positioning support unit for X-ray imaging equipment | |
| EP3104937B1 (en) | Image guided radiotherapy | |
| Binder et al. | A robotic C‐arm fluoroscope | |
| CN109938835B (en) | Method and robot system for registration when adjusting instrument orientation | |
| Peng et al. | Design and kinematic analysis of a hybrid manipulator for spine surgery | |
| CN113954082B (en) | Control method, control equipment and auxiliary system suitable for puncture surgical mechanical arm | |
| US8403821B2 (en) | Radiotherapy apparatus controller and radiation irradiating method | |
| JP7500272B2 (en) | Registration method, registration program, and puncture system | |
| US20170071557A1 (en) | Aligning a field of view of a medical device with a desired region on a subject's body | |
| CN202875358U (en) | Device for positioning target organ during tumor radiotherapy | |
| Wang et al. | Design and kinematic analysis of a 6-dof parallel robot for image-guided surgery | |
| JP2011104183A (en) | Radiotherapy apparatus control method and radiotherapy apparatus controller | |
| KR102612603B1 (en) | 2d-3d image registraion method and medical operating robot system thereof | |
| JP2022009468A (en) | Positioning device and positioning method | |
| WO2018225234A1 (en) | Positioning device and positioning method |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| FEPP | Fee payment procedure |
Free format text: ENTITY STATUS SET TO UNDISCOUNTED (ORIGINAL EVENT CODE: BIG.); ENTITY STATUS OF PATENT OWNER: LARGE ENTITY |
|
| AS | Assignment |
Owner name: SIEMENS HEALTHCARE GMBH, GERMANY Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNOR:PATEL, ANKIT;REEL/FRAME:063419/0587 Effective date: 20230418 |
|
| STPP | Information on status: patent application and granting procedure in general |
Free format text: NON FINAL ACTION MAILED |
|
| STPP | Information on status: patent application and granting procedure in general |
Free format text: RESPONSE TO NON-FINAL OFFICE ACTION ENTERED AND FORWARDED TO EXAMINER |
|
| STPP | Information on status: patent application and granting procedure in general |
Free format text: NOTICE OF ALLOWANCE MAILED -- APPLICATION RECEIVED IN OFFICE OF PUBLICATIONS |
|
| STPP | Information on status: patent application and granting procedure in general |
Free format text: PUBLICATIONS -- ISSUE FEE PAYMENT VERIFIED |
|
| STPP | Information on status: patent application and granting procedure in general |
Free format text: PUBLICATIONS -- ISSUE FEE PAYMENT VERIFIED |
|
| AS | Assignment |
Owner name: SIEMENS HEALTHINEERS AG, GERMANY Free format text: ASSIGNMENT OF ASSIGNORS INTEREST;ASSIGNOR:SIEMENS HEALTHCARE GMBH;REEL/FRAME:066267/0346 Effective date: 20231219 Owner name: SIEMENS HEALTHINEERS AG, GERMANY Free format text: ASSIGNMENT OF ASSIGNOR'S INTEREST;ASSIGNOR:SIEMENS HEALTHCARE GMBH;REEL/FRAME:066267/0346 Effective date: 20231219 |
|
| STCF | Information on status: patent grant |
Free format text: PATENTED CASE |