The robotic system (Fig. 1) consists of the following major components: the MRSMR; an optical navigation system (NDI, Waterloo, Ontario, Canada); a workstation to run the 3D mandibular reconstruction surgery design software (MRSDS); and a main workstation to run the application and robot control.
In this paper, a novel robot system was designed with three arms to realize the holding and embedding motion. Two of the three arms, named left and right holding arms, realize holding the mandibular ramus, while another arm, named middle operating arm, completes to embed the new reconstructed mandible. During the surgery, the left and right arm aims to hold the head and keep the right position and the middle arm clamps the fibular to place the right position to operation for surgeons.
Mandibular reconstructive surgery multi-arm robot
Based on the requirements for mandibular reconstructive surgery, the MRSMR was designed with three arms. Each arm consists of six active degrees of freedom (DOFs) and one passive DOF. The first three DOFs (joints 1–3) achieve positioning within the working space, and the other three DOFs (joints 4–6) are used to make orientation adjustments. The passive DOF is used by the surgeon to assist with orientation adjustments. The two holding arms need to arrive near the mandibular rami. They then adjust and hold the rami in the appropriate position and orientation. The middle operating arm takes fibular implants to the surgical area being addressed.
Figure 2 shows the DOFs’ configuration of the middle arms. The first DOF of each arm is used to accomplish vertical movement, and joints 2 and 3 DOFs of each arm can rotate in the level plane. The first three DOFs decide the position of the end-effectors. The last three DOFs are in the robot’s wrist, which can control the required orientation of end-effectors. Figure 3 shows the prototype of the mandibular reconstructive surgery multi-arm robot.
With the requirements of safety, robustness, and real-time communication, the control system of the robot was designed based on the controller area network bus (CAN-bus). The whole control system structure is shown in Fig. 4. The joints of the arms are driven by a motor and a reducer. Each joint, which is equipped with an incremental encoder and a hall sensor for achieving the absolute position, has a digital servo-driver and controller. There is an emergency stop in each controller for the motor to ensure the safety of the system. All joint controllers communicate with a personal computer (PC)-based workstation via the CAN-bus.
In the robotic system, Omega.6 (Force Dimension, Nyon, Switzerland), which is designed by Force Dimension, is used as master manipulator. Three arms of the robot are employed as slave manipulators. As shown in Fig. 5, the structures of master and slave manipulator are heterogeneous. To achieve real-time control, the mapping relationship between master and slave manipulators in the world coordinate system should be built. Considering the configuration of master and slave manipulators, the first three joints (joints 1–3) between master and slave manipulators are mapped through Cartesian coordinate system, as well as the other three joints (joint 4–6) are mapped through Joint coordinate system. Since the joint space is ineffective, the research of control method in Cartesian space is pivotal. In Cartesian space, inverse kinematic is the most essential factor. To get unique solution in inverse kinematics and improve response rate between master and slave manipulators, a method based on theory of differential transform, which substitute displacement in very short period for instantaneous velocity of joints, is adopted.
NDI navigation system
The NDI optical tracking system was used as the 3D coordinate measurement system for the real model of the patient and robot, as shown in Fig. 6. In the optical tracking system, a passive probe and passive rigid body were used for coordinate measurements. The optical tracker was used to position the robot and locate the position and orientation of the end-effectors. Optical tracker control was accomplished by the PC-based workstation.
The optical navigation method was developed for the 3D reconstructed model, real patient model, and robot so the robot could be guided through coordinate transformation with target position input. Figure 7 shows the coordinate transformation. The registration between the 3D reconstructed image and the skull model utilizes point-based registration. The optical tracker is used to calibrate the position of the robot using a passive rigid body attached to the robot.
3D mandibular reconstructive surgery design software
A high-quality 3D craniofacial visualization system for surgical designing has been developed. The system is based on an open framework to allow improvement with new features, which can be easily plugged in. A variety of efficient tools (e.g., stoke-based direction volume object cutout) is provided to reduce the tedious user–robot interaction. Some solutions were introduced to improve the quality of 3D medical visualization. The system is already used for medical imaging data visualization, craniofacial surgical planning, and surgical navigation.
Application controller
The application control software, which includes robot control, runs on a workstation that contains a real-time interface. The application control includes the image display and operation, robot operation. The robot task communicates with the robot via CAN-bus and performs basic functions, such as receiving joint feedback. The control task implements the supervisory control layer. Its functions are to provide force and motion control. It also provides the interfaces to the force sensor and the navigation system. The robot and control tasks both require periodic, real-time execution. The main thread handles the graphic interface, which is implemented using the Fast Light Toolkit (www.fltk.org) [20] and drives the application procedural flow. It also sends the data to MRSDS for visualization.
Registration and calibration
In this application, the surgeon uses MRSDS to design the surgery. Information is loaded into the application control software, which must ultimately use it for motion in the robot world frame. A complete set of transformations is shown in Fig. 7. Although the navigation system and MRSDS both read the imaging data, they use different conventions for the coordinate system. Therefore, we require a fixed transformation between the navigation frame and the MRSDS frame. The transformation between the two frames is obtained using registration methods provided by the navigation system. A point-based registration was used in the experiments, where a tracked, hand-held pointer probe is used to touch at least four features attached to the skull prior to obtaining the computed tomography (CT) data. The transformation between the robot world frame and the navigation system frame is obtained by moving the robot into six different positions, recording the end-effectors’ position in each coordinate system, and applying a standard point-based registration method. The robot kinematics already provides the location of the end-effectors with respect to the world frame. These offsets are obtained simultaneously via a standard pivot calibration method.