Browse Subject Areas

Click through the PLOS taxonomy to find articles in your field.

For more information about PLOS Subject Areas, click here.

  • Loading metrics

Optimization based trajectory planning for real-time 6DoF robotic patient motion compensation systems

Optimization based trajectory planning for real-time 6DoF robotic patient motion compensation systems

  • Xinmin Liu, 
  • Rodney D. Wiersma



Robotic stabilization of a therapeutic radiation beam with respect to a dynamically moving tumor target can be accomplished either by moving the radiation source, the patient, or both. As the treatment beam is on during this process, the primary goal is to minimize exposure of normal tissue to radiation as much as possible when moving the target back to the desired position. Due to the complex mechanical structure of 6 degree-of-freedom (6DoF) robots, it is not intuitive as to what 6 dimensional (6D) correction trajectory is optimal in achieving such a goal. With proportional-integrative-derivative (PID) and other controls, the potential exists that the controller may generate a trajectory that is highly curved, slow, or suboptimal in that it leads to unnecessary exposure of healthy tissue to radiation. This work investigates a novel feedback planning method that takes into account a robot’s mechanical joint structure, patient safety tolerances, and other system constraints, and performs real-time optimization to search the entire 6D trajectory space in each time cycle so it can respond with an optimal 6D correction trajectory.


Computer simulations were created for two 6DoF robotic patient support systems: a Stewart-Gough platform for moving a patient’s head in frameless maskless stereotactic radiosurgery, and a linear accelerator treatment table for moving a patient in prostate cancer radiation therapy. Motion planning was formulated as an optimization problem and solved at real-time speeds using the L-BFGS algorithm. Three planning methods were investigated, moving the platform as fast as possible (platform-D), moving the target along a straight-line (target-S), and moving the target based on the fastest descent of position error (target-D). Both synthetic motion and prior recorded human motion were used as input data and output results were analyzed.


For randomly generated 6D step-like and sinusoidal synthetic input motion, target-D planning demonstrated the smallest net trajectory error in all cases. On average, optimal planning was found to have a 45% smaller target trajectory error than platform-D control, and a 44% smaller target trajectory error than target-S planning. For patient head motion compensation, only target-D planning was able to maintain a ≤0.5mm and ≤0.5deg clinical tolerance objective for 100% of the treatment time. For prostate motion, both target-S planning and target-D planning outperformed platform-D control.


A general 6D target trajectory optimization framework for robotic patient motion compensation systems was investigated. The method was found to be flexible as it allows control over various performance requirements such as mechanical limits, velocities, acceleration, or other system control objectives.


Modern radiation therapy (RT) delivery methods have evolved to the extent that technologies such as Intensity Modulated Radiation Therapy (IMRT) or Volumetric Modulated Arc Therapy (VMAT) can now tightly conform radiation to the 3D shape of a target with millimeter (mm) accuracy [1, 2]. This opens up the possibility of further radiation dose escalation to the tumor while still keeping doses low to surrounding organs-at-risk (OAR). However, as RT becomes increasingly conformal, and tends toward higher dose over fewer fractions, the issue of patient motion becomes ever more critical to address [3]. In stereotactic radiosugery (SRS) or stereotactic body radiation therapy (SBRT) small, highly focused, and accurate radiation beams are used to escalated doses in 1-5 treatments as opposed to smaller doses over 20-30 treatments. In such cases motion-related errors of even 1-2 mm can be significant.

Adaptive radiation therapy (ART) methods aim to address the RT motion management problem by using image guidance to locate the position of targets and then adapting the radiation dose to conform to these new positions. One form of ART is where dose re-planning is rapidly performed before the start of each treatment fraction while the patient is on the linear accelerator (LINAC). A daily cone-beam CT (CBCT) is taken by the LINAC, and deformable image registration (DIR) and dose recalculation is performed to correct the tumor and OAR volumes for shrinkage, expansion, motion, or other positional changes that may have occurred after the initial planning CT scan [4]. A number of studies have evaluated the benefits of ART, indicating improved target coverage and reduced normal tissue toxicity [58]. However, current ART modalities cannot address changes that may take place during radiation beam delivery. Lung, prostate, pancreas, liver, and other thoracic and abdominal tumors have been shown to move as much as 35 mm with breathing, rectal filling, intestinal gas, or other types of biological motion [9, 10]. Clinical methods to manage such motion include beam gating, abdominal compression, or breath-hold [1114]. In recent years, significant research has been invested in exploring dynamic motion management strategies, such as moving the radiation source, the patient, or both [15, 16]. Here the primary goal is to stabilize the radiation beam with respect to a dynamically moving target. As the target can move along both translational (x, y, z) and rotational (pitch, row, yaw) axes as a function of time, precise positioning of the patient and LINAC becomes extremely challenging. This is especially true for single-isocenter-multiple-target SRS, where small rotations can lead to large positional errors for targets located away from isocenter, resulting in poor or missed target dose coverage and degraded treatment effectiveness [1722].

To effectively deal with intra-fractional patient motion, it is necessary to use a motion control algorithm that can respond to both translational and rotational deviations in real-time. Various motion control algorithms have been investigated in RT, with the most focusing on real-time lung tumor motion compensation using a moving patient treatment table. D’Souza et al. employed a 1D controller that was used to drive a LINAC table such that it moves in phase with target, but in the opposite direction, to maintain the patient translational position [15]. Other methods used adaptive filter prediction and predetermined dynamic models to determine appropriate positioning commands [23, 24]. A proportional integral (PI) controller was developed and evaluated for a 1 degrees-of-freedom (DoF) treatment table tracking system to counter steer respiratory tumor motion [25]. A coordinated dynamics-based proportional integral derivative (PID) control strategy was used to control the robotic system for continuously tracking translational position of the tumor [26]. The efficacy of this method was investigated by extensive computer simulation on two commercially available couches. Use of a linear Kalman filter to predict the surrogate motion with a linearized state space model to predict table position and velocity were investigated [27]. A model predictive control (MPC) of a robotic treatment table for motion compensation was reported in [28]. To maintain dynamic behavior of systems in the face of perturbations and other uncertainties, a robust control for parallel robotic platforms was investigated and compared with a widely used PID approach using extensive computer simulations [29]. For robotic SRS based head motion with angular stabilization, a decoupling control method for a 4D (xyz+pitch) robot was investigated [30, 31].

As the radiation beam is on during real-time patient 6DoF motion compensation, the target correction trajectory must be optimal both spatially and temporally in order to reduce unnecessary exposure of healthy tissue to radiation. Most prior investigations were limited to only 3DoF translational (xyz) motion, and therefore are not suitable to 6DoF robotic systems. Applying such methods to a 6DoF robot can result in a correction that may reach the desired position following a path that is slow, highly curved, or otherwise suboptimal. Additionally, most prior works have focused on respiratory motion compensation, and have employed the use of prediction algorithms to buffer against system lag times. Such methods are therefore not suitable for prostate, liver, head, or other types of motion that can be highly unpredictable [32]. To address these issues, we have developed for the first time, a novel optimization based motion controller that takes into account both robot mechanical constraints and patient safety tolerances, and performs a search over all possible 6D correction trajectories in order to select one that is most optimal. The method is universal as it can be applied to any robotic system provided that the robot’s joint configuration is well-known. Since the method formulates the correction trajectory problem as an objective function to be optimized, various constraints can be easily applied on actuator mechanical limits, patient velocities, and other aspects of the system that must operate within fixed limits during the motion compensation process. We demonstrate that standard convex optimization methods can be used to solve this problem at real-time speeds. As the controller responds with the most optimal path, robot lag time is also reduced, allowing for motion compensation in cases of slow unpredictable motion without the use of prediction. In cases of rapid, but predictable motion, such as lung based tumors or other respiratory coupled targets, the lower lag time reduces the prediction window duration. This is beneficial from a patient safety standpoint, where prediction accuracy deteriorates the further an algorithm must predict in the future.

Materials and methods

Robotic system simulations

Similar to other works that have investigated robotic motion control, we employ the use of computer simulation to test various kinematic and dynamic properties of the robotic system [26, 27]. As shown in Fig 1, dynamic computer simulations of a 6DoF SRS system and a 6DoF LINAC treatment table were constructed using Matlab (Mathworks, Natick, MA). The SRS simulation consists of six linear actuators arranged in a parallel kinematic fashion that performs real-time head motion stabilization by moving a platform (end-effector) that supports the patient’s head [33, 34]. The treatment table simulation is modeled after a commercial product (PerfectPitch, Varian Medical System, CA), and is a serial-parallel kinematic system where the platform moves the entire patient.

Fig 1. Illustrative diagram depicting 6DoF medical robotic systems (a)(b) and the concept of motion trajectories in different spaces (c).

Three types of trajectories involved in the motion compensation: joint, platform, and target. To send the target from G back to the desired position L in operational space, a motion of the platform from P1 to P2 is needed, and such a motion can be implemented by changing the actuator lengths from J1 to J2 in the joint space. As shown, performing a straight-line trajectory in one space can result in a highly curved trajectories in other spaces.

The clinical target to be stabilized with respect to the treatment beam will be considered as a rigid body and thereby represented by 6D coordinates that include the linear position (x, y, z) and the orientation (pitch, roll, yaw). The target is located at position G in the LINAC coordinate frame, and is tracked in real-time during the treatment using a suitable 6DoF patient motion monitoring device such as kV fluoroscopy [35, 36], infrared (IR) markers [32], or 3D surface imaging [37]. The desired position (setpoint) is given as L, and corresponds to the LINAC isocenter. As shown in Fig 1, the motion control problem can be divided into two spaces: joint (robot actuators) and operational (platform and target). In the simplest case, where a robot’s axes are all aligned with the LINAC frame, and one only considers 3D translational motion (xyz), the joint, platform, and target will all move along the same trajectory. In this case one does not require trajectory planning, as a straight-line trajectory from G to L will always be optimal. However, with a 6DoF robot, that is capable of both translational and rotational motion, the joint, operational, and target trajectories may differ substantially. For example, a straight-line target trajectory (blue dashed line), may result in highly curved joint and platform trajectories. It is no longer intuitive as to what 6D trajectory is now optimal both spatially and temporally.

Robotic motion compensation scheme

For a given measured target position with a displacement away from the desired setpoint, the first step is to compute what is the required robot platform position for returning the target back to the setpoint. This can be done by the signal flow diagram in Fig 2. Suppose the measured target position is (rg, ψg), the position of the platform is (ru, ψu), and the position of the target in the platform frame is (rgu, ψgu). Then, (1) where Ω(⋅) is the direction cosine matrix, and (rgu, ψgu) is the target position in the platform coordinate frame. The position (rgu, ψgu) can be calculated by using the current platform position and the measured target position, (2) Assume that the target position with respect to the platform remains unchanged during each robot time cycle, it can be verified that by moving the platform to the following position , (3) the target will move back to the desired position.

The actuator length of the robot can be calculated accordingly based on the platform position (ru, ψu) by inverse kinematics. Suppose the coordinates of the robot joints in the LINAC coordinates frame is , and the coordinates of the corresponding joints at in the platform frame is . Then the actuator length is given by (4) for i = 1, 2, ⋯, 6.

For easy reference, let us make the following denotations. Denote the 6D target and platform position vectors as x ≔ (rg; ψg) and u ≔ (ru; ψu), respectively. Here (y; z) is used to denote the column vector (y z). Denote initial positions as xo = x(0) and uo = u(0), initial actuator length as 6D vector o = (0). Denote the desired target position as , the required position of platform that pushes the target back to the desired position as , and the corresponding actuator length as .

Optimization based trajectory planning

Once the start and desired positions of the platform are known, the next step is to design a suitable trajectory between these two points. For reference, a path denotes the locus of points in a space and is a pure geometric description of motion, while a trajectory is a path with timing information [38]. For robotic motion compensation it is critical that the target trajectory converges to the desired position in an optimal way, such that a minimum time, shortest path, or steepest descent of positional error is achieved. Failure to do so will lead to unnecessary exposure of healthy tissue to radiation and poor tumor dose conformality.

To solve this problem, trajectory planning will be considered by three trajectories in two spaces: joint trajectory in the joint space, and platform trajectory and target trajectory in the operational space (Fig 1). When the platform moves along a trajectory in the operational space, u(k), k = 0, 1, ⋯, n with u(0) = uo and for certain n, the target will approach the desired position following a certain trajectory in the operational space, x(k), k = 0, 1, ⋯, n with x(0) = xo and . To implement such an platform trajectory, the actuator length should thus follow a certain trajectory in the joint space, (k), k = 0, 1, ⋯, n with (0) = o and .

Due to the many parameters involved, it is not intuitive as to what trajectory is optimal both spatially and temporally. As can be seen in Fig 1, following the shortest platform path (platform-S) is not necessarily the best path for the target. Fortunately, such problems can be solved efficiently in real-time by use of optimization algorithms such as the quasi-Newtonian Limited-Broyden-Fletcher-Goldfarb-Shannon (L-BFGS) algorithm [39], Proximal Operator Graph Solver (POGS) [4043], or other fast optimization algorithms. As a rule, the correction trajectory must meet control objectives and are subject to the robot’s mechanical constraints and system’s dynamic constraints. The robot’s actuator constraints can be specified in joint space as, (5) where Δmax is the limit of actuator length change in each step. And the dynamic constraints can be specified in operational space as (6) where the vector vmax is the maximum 6DoF motion of the platform in one step.

By use of (4), the constraint (5) can be represent as the following platform motion constraints, (7) where B is the Jacobian matrix that can be considered as a constant matrix in each time cycle and is computed based on x(k) and (k).

To facilitate optimal target trajectory planning, the robot system is first discretized. Assume that the target position is unchanged with respect to the platform, i.e., (rgu, ψgu) is constant, then (1) can be represented as x = f(u), where x and u are the 6DoF position vectors of the target and the platform, respectively. The discrete system is given by (8)

A general optimal target trajectory planning can be formulated as (9) This nonlinear optimization problem can be approximated as a problem on linear systems. The linearization is performed in each time cycle, so it can describe the system in each small motion accurately. Consider x(k + 1) = f(u(k + 1)) and a small platform motion in each step v(k) = u(k + 1) − u(k). By linearization, the motion compensation discrete system is given by (10) where the matrix A (11) depends on both (ru, ψu) and (rgu, ψgu) of moment k, and can be updated in each step.

The target can move back to the desired position following a straight-line in the target space, and such a trajectory can be obtained by defining an appropriate h in (9). This path is interpolated between xo and , (12) where the scalar 0 ≤ μ ≤ 1 is k dependent, and μ can be maximized for a quick motion compensation to the desired target position . The optimization can be implemented step-by-step. For simplification, consider only mechanical constraints (7). In each step, let xo = x(k − 1). The desired next target position is (12), and the required platform motion is . The scalar μ should be found to minimize . This is equivalent to minimize (μ − 1)2, subject to . Thus, it can be verified that the fastest straight target trajectory is given by (13) Refer to such target straight-line planning as target-S. In target-S, the target follows a straight line for the start point to the end point, and the required platform and actuator length follow curved lines in operational space and joint space, respectively (Fig 1).

As forcing the robot to move the target along a straight-line path can lead to over constraining the system, it does not fully exploit the robot’s potential in reducing the target’s position error in a temporally optimal way. To include both spatial and temporal components in the optimization, a steepest descent of target position error in each step can be used by formulating (9) as follows, (14)

For each step, xo is updated, xo = x(k − 1), and according to (10), the next step target position is x(k) = xo + Av, where the vector v = u(k) − u(k − 1) is the platform motion to be optimized. This fastest reduction in target error positional error planning (14) will be referred to as target-D planning.

Evaluation of robotic compensation for standard motions

The robotic SRS system was evaluated by two synthetic motion standards: step-like motion and oscillating motion. Step motion was simulated since it can represent system response performance to a sudden target change. Sinusoidal motion was considered since it evaluates how well the system responds to dynamical motion and is closely related to target oscillation caused by respiratory motion.

Evaluation of robotic compensation for volunteer head motion data

Both SRS and couch robots were tested using previously recorded human data. Real-time 6D head positional data was obtained under IRB approved studies IRB14-0040 and IRB14-0535 at the University of Chicago [22]. Real-time 6D prostate tumor motion was obtained from the publicly available ACRF Image X Institute patient motion repository Alnaghy et al [44].


Step-like and sinusoidal target motion

The simulated robotic SRS system was tested against sudden step-like displacements of the target away from the setpoint (Fig 3(a)). System response to this motion using platform-D control, target-S planning and target-D planning is shown in Fig 3(b). Here each point represents a 0.15 s time interval and the vector arrows attached to each point denote rotations. Although all planning strategies eventually converged to the setpoint, it can be seen that certain strategies were more appropriate to motion compensation in RT. For platform-D planning (black line), the target can deviate significantly from a straight-line path and can take a long time to converge. In this case, the target temporally moved further away and took approximately 1.6 s to reach a value less than 1 mm/deg away from the setpoint. From a target perspective, such a trajectory is not optimal as it would lead to unnecessary irradiation of healthy tissues. For target-S planning (blue line), the target moved at a constant speed and followed the expected straight-line path. However, although optimal spatially, this trajectory is not optimal temporally as it takes approximately 1.5 s to reach less than 1 mm/deg away from the setpoint. For target-D planning (red line), the target followed a path that was close to a straight-line and converged to the setpoint within 0.3 s. In this case, both spatial and temporal components of the trajectory were optimal. The time course of the three trajectory planning strategies is given in Fig 3(c).

Fig 3.

(a)(b)(c): System response to step like target deviations. (a) Input motion. (b) Target trajectory with orientation shown every 0.15 seconds. (c) Target displacement versus time. (d) Integrated trajectory errors for 100 simulations using randomly generated 6D input motion within 2mm/1deg. Errors were normalized to target-S planning case.

To test system response against many arbitrary 6D directions, 100 randomly generated target step-like displacements with amplitudes within a 2mm/1deg were inputted into the simulated robotic SRS system. The performance of different control/planning methods was evaluated by the target trajectory error defined as (15) where the difference from the desired setpoint is summed over all time steps. The target trajectory errors of 100 simulations are plotted in Fig 3(d). The trajectory errors of target-S planning were smaller than those of platform-D control in 56 cases, and target-D planning had the smallest trajectory error in all 100 cases. On average, target-D planning was found to have a 45% smaller target trajectory error than platform-D control, and a 44% smaller target trajectory error than target-S planning.

The performance of optimization based trajectory planning was also evaluated for sinusoidal target motion around the desired setpoint. Fundamentally, due to lag time between measurement and robot actuation, the corrected target position will not remain at the setpoint, but rather, the target will move around the setpoint with a smaller amplitude of oscillation. This amplitude can therefore be used as an indicator of the efficiency of the motion correction algorithm. The system response of platform-D control, target-S planning and target-D planning for a randomly generated 6D target oscillation is shown in Fig 4(a), 4(b) and 4(c). The trajectory of target-D planning was found to converge to a steady oscillation faster than platform-D control and target-S planning, and also showed a smaller oscillation amplitude. Fig 4(d) shows the resultant errors for 100 simulations using randomly generated sinusoidal input motion with amplitudes within 2mm/1deg. Target-S planning has smaller target trajectory errors than platform-D control in 68 cases, and target-D planning has the smallest target trajectory errors in all 100 cases. On average, target-D planning has 52% smaller target trajectory error than platform-D control, and has 48% smaller trajectory error than target-S planning.

Fig 4.

(a)(b)(c): System response to sinusoidal target motion deviation. (a) Input sinusoidal target motion. (b) Target trajectory shown every 0.2 seconds. (c) Target displacement versus time. (d) Integrated target trajectory errors for 100 simulations using randomly generated input motion within 2 mm / 1 deg. Errors were normalized to target-S planning case.

Human volunteer motion

Uncorrected 6DoF head motion of six volunteers was record over a 15 minute tracking period by use of a stereoscopic IR marker tracking system with a 12 Hz sampling rate [22]. In all cases no immobilization was applied to the volunteers. The motion was inputted into the robotic SRS simulation, and platform-D control, target-S planning, and target-D planning were applied, and their performances compared. Fig 5 is one example showing a volunteer displaying involuntary drifting and rapid head motion changes due to respiratory coupling. In his case platform-D control fails to meet the 0.5 mm / 0.2 deg tolerance objective, whereas, the target-D planning is well within tolerance.

Fig 5. Different trajectory planning strategies for real-time motion compensation of volunteer head motion showing strong respiratory coupling.

To demonstrate the algorithm’s applicability to many different types of 6DoF robot systems, Fig 6 shows the results of performing real-time 6D prostate motion compensation using a treatment table. If one were to use a platform-D control to move the platform to the required position as fast as possible, it leads to large intermediate target position errors. On the other hand, both target-S planning and target-D planning were acceptable, while the displacement for target-D planning is within tolerance 1.5 mm / 1.5 deg.

Fig 6. Different trajectory control/planning strategies for real-time motion compensation of a prostate tumor using a 6DoF robotic treatment table.


As the radiation beam is always on during the motion compensation process, the 6D correction trajectory must be optimal both spatially and temporally in order to maximize radiation to the target and minimize unintentional irradiation of healthy tissues. As can be seen in Fig 3(b) for a sudden step-like deviation, simply moving the patient support device to the desired position without regard to the target trajectory can result in highly curved trajectories. Although such trajectories are completely acceptable in the vast majority of robot applications, where one is only concerned with moving an object from point A to point B, this is not acceptable in real-time motion compensation using RT as such trajectories may temporally bring OARs, or other sensitive structures, directly into the path of the radiation beam. On the other hand, forcing the target to move along an ideal straight-line, or any well-defined 6D path in target space, can lead to prolonged correction times (target-S plan) as the system becomes over-constrained, in that the robot must move its joints in a fixed way. The use of optimization to explore all potential 6D trajectories by taking into account the robot’s joint configuration allows for the various degrees of freedom of the robot to be fully exploited. For example, target-D planning was found to provide a good balance between both spatial and temporal efficiency. As shown in Fig 3(c), the 6D target error is quickly reduced, such that in 0.3 s it is approximately 1 mm/deg away from isocenter, compared to ≈ 2s using the other approaches.

Typically, in lung tumor motion compensation, or for other targets coupled to respiratory motion, the high velocities necessitate the use of prediction algorithms in order to account for the inherent lag time between actual target position readout and the motion controller response. As shown in Fig 4, a less optimal correction trajectory will have larger lag times and consequently require more motion prediction. Numerous studies have shown, that the accuracy of prediction algorithms becomes substantially more difficult the further the algorithm must predict into the future [45]. In this respect, optimization based trajectory planning can improve the accuracy of such motion compensation systems in that an optimal 6D correction path would reduce lag time and consequently would require less prediction. Fig 4 compares several different trajectory planning strategies in handling 6D oscillatory motion. As shown in Fig 4(b), all three different planning strategies reach equilibriums that orbit around the setpoint. However, the target-D planning method comes closest to the desired setpoint, which is primarily due to its correction path being more optimal than the other methods.

The optimization based motion planning method presented in this work is general in nature and can be applied to any robotic system. The main difference between the compact hexapod and the 6DoF patient treatment table system investigated in this work is the joint space. By defining the table joint space, the method can be fully utilized in order to find optimal 6D trajectories. This is shown in Fig 6, where real-time motion compensation of prostate motion is performed using the treatment table. However, it should be noted that patient tables are typically designed for general purpose treatment in all parts of the body, and therefore typically have mechanical joint positions inferior of the patient’s pelvis in order to prevent significant attenuation or scattering of the radiation beam. When treating targets in the brain, these joints are located far from isocenter and using such a system for SRS motion compensation will pose high demands on the control system in terms of motor synchronization due to mechanical translational and rotational shift. For example, the treatment table investigated in this work (TruePitch, Varian Medical Systems, CA) [46], has a pitch/roll pivot point located approximately 1500 mm away from the patient’s head. Therefore, a small 0.05deg pitch error can cause a 1.31 mm displacement error in the vertical direction of the target. On the other hand, site specific robots such as the robotic SRS system are located near the patient’s head, and have a joint-to-isocenter distance that is approximately 1/4—1/3 that of a table, allowing for less demanding mechanical system tolerances.

In order to find the most optimal way to move the robot, the optimizer operates directly on the robot’s joint space. Therefore, this technique is more demanding to implement than other motion controllers, such as PID, which can treat the robot like a black box and adjusts inputs until a desired output is achieved. In this case complete knowledge of the robot’s joint position geometry together with dynamical capabilities of the motor systems is needed. Failure to provide accurate mechanical and dynamical robot constraints can lead to systematic errors where the optimizer finds trajectory solutions that result in target trajectory errors.

In optimal trajectory planning, it was assumed that we know the robot mechanical structure, actuator positions, and the necessary coordinate transformations to calibrate the robot to the LINAC frame of reference. In actual clinical practice, there many be robot flex, mechanical play, or other conditions that will lead to deviations from this ideal. In this case, it is necessary to perform a robot calibration procedure. For robotic SRS, such a calibration was demonstrated by pre-programming the robot to move to different positions in 6D space while simultaneously monitoring the actual positions with respect to the LINAC frame using a real-time 6D tracking system. A Kabsch algorithm was then used to compute coordinate frame relations between the robot and LINAC frames [34]. We are currently investigating this technique for use on 6DoF couch systems.


A general 6D target trajectory optimization framework for robotic patient motion compensation systems was investigated. Motion planning was formulated as an optimization problem and solved in real-time using a well-known convex optimization algorithm. The method was found to be flexible as it meets various performance requirements such as mechanical robot limits, patient velocities, or other aspects of the system that must operate within fixed limits during the motion compensation process. Both straight-line path and steepest decent trajectories of target error were investigated. In all cases, the steepest decent of the target trajectory was optimal both spatially and temporally.


  1. 1. Deodato F, Cilla S, Macchia G, Torre G, Caravatta L, Mariano G, et al. Stereotactic radiosurgery (SRS) with volumetric modulated arc therapy (VMAT): interim results of a multi-arm phase I trial (DESTROY-2). Clinical Oncology. 2014;26(12):748–756. pmid:25175042
  2. 2. Otto K. Volumetric modulated arc therapy: IMRT in a single gantry arc. Medical physics. 2008;35(1):310–317. pmid:18293586
  3. 3. Langen K, Jones D. Organ motion and its management. International Journal of Radiation Oncology* Biology* Physics. 2001;50(1):265–278.
  4. 4. Guckenberger M, Wilbert J, Richter A, Baier K, Flentje M. Potential of adaptive radiotherapy to escalate the radiation dose in combined radiochemotherapy for locally advanced non–small cell lung cancer. International Journal of Radiation Oncology* Biology* Physics. 2011;79(3):901–908.
  5. 5. van de Bunt L, Van der Heide UA, Ketelaars M, de Kort GA, Jürgenliemk-Schulz IM. Conventional, conformal, and intensity-modulated radiation therapy treatment planning of external beam radiotherapy for cervical cancer: The impact of tumor regression. International Journal of Radiation Oncology* Biology* Physics. 2006;64(1):189–196.
  6. 6. Kuo YC, Wu TH, Chung TS, Huang KW, Chao KSC, Su WC, et al. Effect of regression of enlarged neck lymph nodes on radiation doses received by parotid glands during intensity-modulated radiotherapy for head and neck cancer. American journal of clinical oncology. 2006;29(6):600–605. pmid:17148998
  7. 7. Yan D. Developing quality assurance processes for image-guided adaptive radiation therapy. International Journal of Radiation Oncology* Biology* Physics. 2008;71(1):S28–S32.
  8. 8. Men C, Jia X, Jiang SB. GPU-based ultra-fast direct aperture optimization for online adaptive radiation therapy. Physics in medicine and biology. 2010;55(15):4309. pmid:20647601
  9. 9. Davies S, Hill A, Holmes R, Halliwell M, Jackson P. Ultrasound quantitation of respiratory organ motion in the upper abdomen. The British journal of radiology. 1994;67(803):1096–1102. pmid:7820402
  10. 10. Ross CS, Hussey DH, Pennington EC, Stanford W, Doornbos JF. Analysis of movement of intrathoracic neoplasms using ultrafast computerized tomography. International Journal of Radiation Oncology* Biology* Physics. 1990;18(3):671–677.
  11. 11. Kubo HD, Hill BC. Respiration gated radiotherapy treatment: a technical study. Physics in Medicine & Biology. 1996;41(1):83.
  12. 12. Lohr F, Debus J, Frank C, Herfarth K, Pastyr O, Rhein B, et al. Noninvasive patient fixation for extracranial stereotactic radiotherapy. International Journal of Radiation Oncology* Biology* Physics. 1999;45(2):521–527.
  13. 13. Kim DJ, Murray BR, Halperin R, Roa WH. Held-breath self-gating technique for radiotherapy of non–small-cell lung cancer: A feasibility study. International Journal of Radiation Oncology* Biology* Physics. 2001;49(1):43–49.
  14. 14. Wiersma RD, McCabe BP, Belcher AH, Jensen PJ, Smith B, Aydogan B. High temporal resolution characterization of gating response time. Medical physics. 2016;43(6Part1):2802–2806. pmid:27277028
  15. 15. D D’Souza W, Naqvi SA, Cedric XY. Real-time intra-fraction-motion tracking using the treatment couch: a feasibility study. Physics in medicine and biology. 2005;50(17):4021.
  16. 16. Murphy MJ. Tracking moving organs in real time. In: Seminars in radiation oncology. vol. 14. Elsevier; 2004. p. 91–100.
  17. 17. Redpath AT, Wright P, Muren LP. The contribution of on-line correction for rotational organ motion in image-guided radiotherapy of the bladder and prostate. Acta Oncologica. 2008;47(7):1367–1372. pmid:18661436
  18. 18. Wang H, Shiu A, Wang C, O’Daniel J, Mahajan A, Woo S, et al. Dosimetric effect of translational and rotational errors for patients undergoing image-guided stereotactic body radiotherapy for spinal metastases. International Journal of Radiation Oncology* Biology* Physics. 2008;71(4):1261–1271.
  19. 19. Winey B, Bussiere M. Geometric and dosimetric uncertainties in intracranial stereotatctic treatments for multiple nonisocentric lesions. Journal of applied clinical medical physics. 2014;15(3):122–132. pmid:24892339
  20. 20. Roper J, Chanyavanich V, Betzel G, Switchenko J, Dhabaan A. Single-isocenter multiple-target stereotactic radiosurgery: Risk of compromised coverage. International Journal of Radiation Oncology* Biology* Physics. 2015;93(3):540–546.
  21. 21. Mancosu P, Reggiori G, Gaudino A, Lobefalo F, Paganini L, Palumbo V, et al. Are pitch and roll compensations required in all pathologies? A data analysis of 2945 fractions. The British journal of radiology. 2015;88(1055):20150468. pmid:26393283
  22. 22. Belcher A. Patient motion management with 6dof robotics for frameless and maskless stereotatic radiosurgery. Ph D Thesis. 2017;.
  23. 23. Wilbert J, Meyer J, Baier K, Guckenberger M, Herrmann C, Heß R, et al. Tumor tracking and motion compensation with an adaptive tumor tracking system (ATTS): system description and prototype testing. Medical physics. 2008;35(9):3911–3921. pmid:18841842
  24. 24. Menten MJ, Guckenberger M, Herrmann C, Krauß A, Nill S, Oelfke U, et al. Comparison of a multileaf collimator tracking system and a robotic treatment couch tracking system for organ motion compensation during radiotherapy. Medical physics. 2012;39(11):7032–7041. pmid:23127094
  25. 25. Lang S, Zeimetz J, Ochsner G, Schmid Daners M, Riesterer O, Klöck S. Development and evaluation of a prototype tracking system using the treatment couch. Medical physics. 2014;41(2).
  26. 26. Buzurovic I, Huang K, Yu Y, Podder T. A robotic approach to 4D real-time tumor tracking for radiotherapy. Physics in medicine and biology. 2011;56(5):1299. pmid:21285488
  27. 27. Haas OC, Skworcow P, Paluszczyszyn D, Sahih A, Ruta M, Mills JA. Couch-based motion compensation: modelling, simulation and real-time experiments. Physics in medicine and biology. 2012;57(18):5787. pmid:22951301
  28. 28. Herrmann C, Ma L, Schilling K. Model predictive control for tumor motion compensation in robot assisted radiotherapy. IFAC Proceedings Volumes. 2011;44(1):5968–5973.
  29. 29. Buzurovic I, Debeljkovic DL. Robust control for parallel robotic platforms. In: Intelligent Engineering Systems (INES), 2012 IEEE 16th International Conference on. IEEE; 2012. p. 45–50.
  30. 30. Liu X, Belcher AH, Grelewicz Z, Wiersma RD. Robotic real-time translational and rotational head motion correction during frameless stereotactic radiosurgery. Medical Physics. 2015;42(6):2757–2763. pmid:26127028
  31. 31. Liu X, Belcher AH, Grelewicz Z, Wiersma RD. Robotic stage for head motion correction in stereotactic radiosurgery. In: 2015 American Control Conference (ACC);.
  32. 32. Wiersma RD, Wen Z, Sadinski M, Farrey K, Yenice KM. Development of a frameless stereotactic radiosurgery system based on real-time 6D position monitoring and adaptive head motion compensation. Physics in medicine and biology. 2009;55(2):389. pmid:20019403
  33. 33. Belcher AH, Liu X, Grelewicz Z, Wiersma RD. Spatial and rotational quality assurance of 6DOF patient tracking systems. Medical Physics. 2016;43(6):2785–2793. pmid:27277026
  34. 34. Belcher AH, Liu X, Grelewicz Z, Pearson E, Wiersma RD. Development of a 6DOF robotic motion phantom for radiation therapy. Medical physics. 2014;41(12):121704. pmid:25471951
  35. 35. Wiersma R, Mao W, Xing L. Combined kV and MV imaging for real-time tracking of implanted fiducial markers a. Medical physics. 2008;35(4):1191–1198. pmid:18491510
  36. 36. Nguyen DT, O’Brien R, Kim JH, Huang CY, Wilton L, Greer P, et al. The first clinical implementation of a real-time six degree of freedom target tracking system during radiation therapy based on Kilovoltage Intrafraction Monitoring (KIM). Radiotherapy and Oncology. 2017;123(1):37–42. pmid:28342648
  37. 37. Wiersma RD, Tomarken S, Grelewicz Z, Belcher AH, Kang H. Spatial and temporal performance of 3D optical surface imaging for real-time head position tracking. Medical physics. 2013;40(11):111712. pmid:24320420
  38. 38. Siciliano B, Sciavicco L, Villani L, Oriolo G. Robotics: modelling, planning and control. Springer Science & Business Media; 2010.
  39. 39. Morales JL, Nocedal J. Remark on “Algorithm 778: L-BFGS-B: Fortran subroutines for large-scale bound constrained optimization”. ACM Transactions on Mathematical Software (TOMS). 2011;38(1):7.
  40. 40. Parikh N, Boyd S. Block splitting for distributed optimization. Mathematical Programming Computation. 2014;6(1):77–102.
  41. 41. Fougner C, Boyd S. Parameter selection and pre-conditioning for a graph form solver. Online at http://stanfordedu/boyd/papershtml. 2015;.
  42. 42. Liu X, Belcher AH, Grelewicz Z, Wiersma RD. Constrained quadratic optimization for radiation treatment planning by use of graph form ADMM. In: American Control Conference (ACC), 2016. American Automatic Control Council (AACC); 2016. p. 5599–5604.
  43. 43. Liu X, Pelizzari C, Belcher AH, Grelewicz Z, Wiersma RD. Use of proximal operator graph solver for radiation therapy inverse treatment planning. Medical Physics. 2017;44(4):1246–1256. pmid:28211070
  44. 44. Alnaghy S, Kyme A, Caillet V, Nguyen D, O’Brien R, Booth J, et al. A Novel Six-Degrees-Of-Freedom (6DoF) Robotic Motion Phantom Quality-Assurance (QA) to Test Advanced Radiotherapy Delivery Approaches. In: MEDICAL PHYSICS. vol. 45. WILEY 111 RIVER ST, HOBOKEN 07030-5774, NJ USA; 2018. p. E682–E682.
  45. 45. Riaz N, Shanker P, Wiersma R, Gudmundsson O, Mao W, Widrow B, et al. Predicting respiratory tumor motion with multi-dimensional adaptive filters and support vector regression. Physics in Medicine & Biology. 2009;54(19):5735.
  46. 46. Schmidhalter D, Fix M, Wyss M, Schaer N, Munro P, Scheib S, et al. Evaluation of a new six degrees of freedom couch for radiation therapy. Medical physics. 2013;40(11). pmid:24320418