skip to main content


Title: An Approach to Modeling Closed-Loop Kinematic Chain Mechanisms, Applied to Simulations of the da Vinci Surgical System
Open-sourced kinematic models of the da Vinci Surgical System have previously been developed using serial chains for forward and inverse kinematics. However, these models do not describe the motion of every link in the closed-loop mechanism of the da Vinci manipulators; knowing the kinematics of all components in motion is essential for the foundation of modeling the system dynamics and implementing representative simulations. This paper proposes a modeling method of the closed-loop kinematics, using the existing da Vinci kinematics and an optical motion capture link length calibration. Resulting link lengths and DH parameters are presented and used as the basis for ROS-based simulation models. The models were simulated in RViz visualization simulation and Gazebo dynamics simulation. Additionally, the closed-loop kinematic chain was verified by comparing the remote center of motion location of simulation with the hardware. Furthermore, the dynamic simulation resulted in satisfactory joint stability and performance. All models and simulations are provided as an open-source package.  more » « less
Award ID(s):
1637759
NSF-PAR ID:
10113819
Author(s) / Creator(s):
Date Published:
Journal Name:
Acta Polytechnica Hungarica
Volume:
16
Issue:
8
ISSN:
1785-8860
Page Range / eLocation ID:
29-48
Format(s):
Medium: X
Sponsoring Org:
National Science Foundation
More Like this
  1. null (Ed.)
    An important problem in designing human-robot systems is the integration of human intent and performance in the robotic control loop, especially in complex tasks. Bimanual coordination is a complex human behavior that is critical in many fine motor tasks, including robot-assisted surgery. To fully leverage the capabilities of the robot as an intelligent and assistive agent, online recognition of bimanual coordination could be important. Robotic assistance for a suturing task, for example, will be fundamentally different during phases when the suture is wrapped around the instrument (i.e., making a c- loop), than when the ends of the suture are pulled apart. In this study, we develop an online recognition method of bimanual coordination modes (i.e., the directions and symmetries of right and left hand movements) using geometric descriptors of hand motion. We (1) develop this framework based on ideal trajectories obtained during virtual 2D bimanual path following tasks performed by human subjects operating Geomagic Touch haptic devices, (2) test the offline recognition accuracy of bi- manual direction and symmetry from human subject movement trials, and (3) evalaute how the framework can be used to characterize 3D trajectories of the da Vinci Surgical System’s surgeon-side manipulators during bimanual surgical training tasks. In the human subject trials, our geometric bimanual movement classification accuracy was 92.3% for movement direction (i.e., hands moving together, parallel, or away) and 86.0% for symmetry (e.g., mirror or point symmetry). We also show that this approach can be used for online classification of different bimanual coordination modes during needle transfer, making a C loop, and suture pulling gestures on the da Vinci system, with results matching the expected modes. Finally, we discuss how these online estimates are sensitive to task environment factors and surgeon expertise, and thus inspire future work that could leverage adaptive control strategies to enhance user skill during robot-assisted surgery. 
    more » « less
  2. This paper presents an iterative Jacobian-based inverse kinematics method for an MRI-guided magnetically-actuated steerable intravascular catheter system. The catheter is directly actuated by magnetic torques generated on a set of current-carrying micro-coils embedded on the catheter tip, by the magnetic field of the magnetic resonance imaging (MRI) scanner. The Jacobian matrix relating changes of the currents through the coils to changes of the tip position is derived using a three dimensional kinematic model of the catheter deflection. The inverse kinematics is numerically computed by iteratively applying the inverse of the Jacobian matrix. The damped least square method is implemented to avoid numerical instability issues that exist during the computation of the inverse of the Jacobian matrix. The performance of the proposed inverse kinematics approach is validated using a prototype of the robotic catheter by comparing the actual trajectories of the catheter tip obtained via open-loop control with the desired trajectories. The results of reproducibility and accuracy evaluations demonstrate that the proposed Jacobian-based inverse kinematics method can be used to actuate the catheter in open-loop to successfully perform complex ablation trajectories required in atrial fibrillation ablation procedures. This study paves the way for effective and accurate closed-loop control of the robotic catheter with real-time feedback from MRI guidance in subsequent research. 
    more » « less
  3. Abstract This paper presents the design, dynamic modeling, and integration of a single degree of freedom (DOF) robotic leg mechanism intended for tailed quadruped locomotion. The design employs a lightweight six-bar linkage that couples the hip and knee flexion/extension joints mechanically, requiring only a single degree of actuation. By utilizing a parametric optimization, a unique topological arrangement is achieved that results in a foot trajectory that is well suited for dynamic gaits including trot-running, bounding, and galloping. Furthermore, a singular perturbation is introduced to the hybrid dynamic framework to address the lack of robust methods that provide a solution for the differential algebraic equations (DAEs) that characterize closed kinematic chain (CKC) structures as well as the hybrid nature of legged locomotion. By approximating the system dynamics as ordinary differential equations (ODEs) and asymptotically driving the constraint error to zero, CKCs can adopt existing real-time model-based/model-predictive/hybrid-control frameworks. The dynamic model is verified through simulations and the foot trajectory was experimentally validated. Preliminary open-loop planar running demonstrated speeds up to 3.2 m/s. These advantages, accompanied by low-integration costs, warrant this leg as a robust, effective platform for future tailed quadruped research. 
    more » « less
  4. Abstract Burst suppression is a phenomenon in which the electroencephalogram (EEG) of a pharmacologically sedated patient alternates between higher frequency and amplitude bursting to lower frequency and amplitude suppression. The level of sedation can be quantified by the burst suppression ratio (BSR), which is defined as the amount of time that an EEG is suppressed over the amount of time measured. Maintaining a stable BSR in patients is an important clinical problem, which has led to an interest in the development of BSR-based closed-loop pharmacological control systems. Methods to address the problem typically involve pharmacokinetic (PK) modeling that describes the dynamics of drug infusion in the body as well as signal processing methods for estimating burst suppression from EEG measurements. In this regard, simulations, physiological modeling, and control design can play a key role in producing a solution. This paper seeks to add to prior work by incorporating a Schnider PK model with the Wilson–Cowan neural mass model to use as a basis for robust control design of biophysical burst suppression dynamics. We add to this framework actuator modeling, real-time burst suppression estimation, and uncertainty modeling in both the patient's physical characteristics and neurological phenomena to form a closed-loop system. Using the Ziegler–Nichols tuning method for proportional-integral-derivative (PID) control, we were able to control this system at multiple BSR set points over a simulation time of 18 h in both nominal, patient varied with noise added and with reduced performance due to BSR bounding when including patient variation and noise as well as neurological uncertainty. 
    more » « less
  5. null (Ed.)
    Robot Dynamic Simulators offer convenient implementation and testing of physical robots, thus accelerating research and development. While existing simulators support most real-world robots with serially linked kinematic and dynamic chains, they offer limited or conditional support for complex closed-loop robots. On the other hand, many of the underlying physics computation libraries that these simulators employ support closed-loop kinematic chains and redundant mechanisms. Such mechanisms are often utilized in surgical robots to achieve constrained motions (e.g., the remote center of motion (RCM)). To deal with such robots, we propose a new simulation framework based on a front-end description format and a robust real-time dynamic simulator. Although this study focuses on surgical robots, the proposed format and simulator are applicable to any type of robot. In this manuscript, we describe the philosophy and implementation of the front-end description format and demonstrate its performance and the simulator's capabilities using simulated models of real-world surgical robots. 
    more » « less