Prostatic hyperplasia and tumor are common diseases, and the minimally invasive surgery inserting the instruments through the urethra into the prostate is commonly conducted. Taking the robotic manipulator for such surgery into consideration, this paper analyses the workspace of the end effector, and proposes the distribution error of the fixed point and the tracking error of manipulator end effector on the cone bottom surface of the workspace as the basis for control implementation of the manipulator. The D-H coordinate system of the manipulator is established and the trajectory planning of the end effector in the Cartesian space is carried out. The digital model was established, and dynamics simulation was performed in Solidworks and Matlab/Simulink environment to guide the manipulator design. Trajectory mapping and synchronization control between virtual model and the actual manipulator are realized based on digital twin technique. The virtual manipulator can reflect the real-time state of the manipulator with data interaction by comparing the dynamics simulation results with the motor current values obtained by experiment. Experiment was carried out with PD feedback control and Newton-Euler dynamics based feedforward control to get the trajectory tracking characteristic of each motor, errors of the fixed point and tracking performance of the end effector of the manipulator. The results show that compared with PD feedback control, feed forward control implementation can achieve a reduction of 30.0% in the average error of the fixed point of the manipulator and a reduction of 33.3% in the maximum error.
Hu Shi
,
Jiajie Li
,
Lianjie Guo
,
Xuesong Mei
. Control Performance Evaluation of Serial Urology Manipulator by Virtual Prototyping[J]. Chinese Journal of Mechanical Engineering, 2021
, 34(1)
: 25
-25
.
DOI: 10.1186/s10033-021-00534-x
[1] Z F Li, Y Yang, Y Su, et al. Current status and thinking of research and application of surgical robots in China. China Medical Equipment, 2019, 16(11): 177-181.
[2] O Meireles, S Horgan. Applications of surgical robotics in general surgery. Surgical Robotics: Systems Applications and Visions, 2011: 791-812.
[3] M Feng, Y L Fu, B Pan, et al. Design and implementation of the robotic end effector for minimally invasive celiac surgery. Robot, 2009, 31(1): 47-52.
[4] X M Du, Y S Zhang. Advances in application of Da Vinci surgical system. China Medical Equipment, 2011, 8(5): 60-63.
[5] J Marescaux, J Leroy, F Rubino, et al. Transcontinental robot-assisted remote telesurgery: Feasibility and potential applications. Annals of Surgery, 2002, 253(4): 487-492.
[6] J Marescaux, J Leroy, M Gagner, et al. Transatlantic robot-assisted telesurgery. Nature, 2001, 413: 379-380.
[7] J M Li, S X Wang, X F Wang, et al. Optimization of a novel mechanism for a minimally invasive surgery robot. The International Journal of Medical Robotics and Computer Assisted Surgery, 2010, 6(1): 83-90.
[8] J M Li, N X Zhou, S X Wang, et al. Design of an integrated master-slave robotic system for minimally invasive surgery. The International Journal of Medical Robotics and Computer Assisted Surgery, 2012, 8(1): 77-84.
[9] R C Locke, R V Patel. Optimal remote center-of-motion location for robotics-assisted minimally invasive surgery. IEEE ICRA, Roma, 2007: 1900-1905.
[10] R Q Ma, S H Hao, W F Zheng, et al. Research on coordinated simulation of robot arm based on MATLAB and ADAMS. Machinery Design & Manufacture, 2010, 4: 93-95.
[11] G Y Wu, Y S Liu, Z Niu, et al. Research on the dead-point problem of spherical micro pump based on virtual prototype. IEEE International Conference on Aircraft Utility Systems, IEEE, 2016.
[12] H Q Sang, C He, J M Li, et al. Dynamic modeling and trajectory tracking control for a 3-dof instrument in minimally invasive surgery. IEEE Robotics and Biomimetics (ROBIO), 2010.
[13] F Edris, S G Liu. An efficient approach for manipulator robot dynamics modeling. International Conference on Computer, Control, Electrical, and Electronics Engineering (ICCCEEE), 2018.
[14] J P Chen, H X Chen, X L Yang, et al. Dynamic simulation analysis of six-degree of freedom medical robotic couch for radiation therapy. China Medical Devices, 2019, 34(8): 76-80.
[15] X Y Kang, Y X Zhao, X Chen. Simulation research of 6-DOF robot arm based on simmechanics. Machine Tool & Hydraulics, 2016, 44(23): 23-29.
[16] U Hagn, R Konietschke, A Tobergte, et al. DLR MiroSurge: A versatile system for research in endoscopic telesurgery. International Journal of Computer Assisted Radiology & Surgery, 2010, 5(2): 183-193.
[17] M Niccolini, G Petroni, A Menciassi, et al. Real-time control architecture of a novel Single-Port lapaRoscopy bimaNual roboT (SPRINT). IEEE International Conference on Robotics and Automation, Roma, 2012: 3395-3400.
[18] G S Mi, H Q Liang. Nonlinear sliding mode control for robotic manipulator based on disturbance observer. Journal of System Simulation, 2019, 31(9): 1935-1941.
[19] W Y Su. Research on trajectory tracking adaptive control algorithm for industrial manipulators. Nanjing: Southeast University, 2018.
[20] X Chen, L Huang, Y Yang. Gravity compensation of an intraocular surgery robot based on computed torque method. Journal of Beijing University of Aeronautics and Astronautics, 2017, 43(6): 1231-1238.
[21] C Y He, L Huang, Y Yang, et al. Research and realization of a master-slave robotic system for retinal vascular bypass surgery. Chinese Journal of Mechanical Engineering, 2018, 31: 78.
[22] S Aksungur, M Aydin, O Yakut. Real-time PID control of a novel RCM mechanism designed and manufactured for use in laparoscopic surgery. Industrial Robot, 2019, 47(2): 153-166.
[23] Y L Fu, B Pan. Research progress of surgical robot for minimally invasive robot. Journal of Harbin Institute of Technology, 2019, 51(1): 1-11.
[24] J J Li, H Shi, L Yang. Inverse kinematics analysis, size optimization and error analysis of urology surgical manipulator. Biomedical Engineering International Conference, 2018.
[25] Z Z Wang, C J Yang, C Y Liu, et al. United simulation of 6 DOF robot with MATLAB and ADAMS. Manufacturing Automation, 2013, 18: 30-33.
[26] H Li, Z X Ma, Z S Ma. Integrated system and modularization of industrial robot. Beijing: Chemical Industry Press, 2018.
[27] Hyowinner. Simulink simulation and code generation technology. Beijing: Beijing University of Aeronautics and Astronautics Press, 2015.
[28] M J Thomas, M L Joy, A P Sudheer. Kinematic and dynamic analysis of a 3-PRUS spatial parallel manipulator. Chinese Journal of Mechanical Engineering, 2020, 33: 13.
[29] W He, W Ge, Y Li, et al. Model identification and control design for a humanoid robot. IEEE Transactions on Systems, Man, and Cybernetics: Systems, 2017, 47(1): 45-57.
