iros 2013 - force-position control for a miniature camera robotic system for single-site surgery
TRANSCRIPT
![Page 1: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/1.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
Irene Rivas Blanco
E. Bauzano ,M. Cuevas-Rodriguez, P. Del Saz-Orozco, V.F. Muñoz
Department of System Engineering and Automation
University of Málaga (Spain)
FORCE-POSITION CONTROL FOR A
MINIATURE CAMERA ROBOTIC SYSTEM FOR
SINGLE-SITE SURGERY
![Page 2: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/2.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
I. INTRODUCTION
II. CAMERA ROBOTIC SYSTEM
III. FORCE-POSITION CONTROL
IV. EXPERIMENTS
V. CONCLUSIONS & FUTURE WORK
INDEX
![Page 3: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/3.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
I. INTRODUCTION
• Single-site surgery
Loss of triangulation between camera and
instruments
Limitation of the range of motion of instruments outside the abdomen
![Page 4: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/4.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
I. INTRODUCTION
• Robotic system for Single-Site surgery
Camera robot
Magnetic holder
Robotic arm
Entry port
Abdominal wall
![Page 5: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/5.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
II. CAMERA ROBOTIC SYSTEM
Wrist attachmentPan
Tilt
-42º 42º
C
B
A
• Wireless Camera Robot
Camera robot
Magnetic holder
![Page 6: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/6.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
III. FORCE-POSITION CONTROL
Hybrid Force-Position
Control
Torque Compensation
• Hybrid force-position control with torque compensation
ROBOT ENVIRONMENT
‐ Hybrid force-position control tracks position reference along thetangent directions of the surface while exerting a force along thenormal direction.
‐ Torque compensation mantains the robot orientationperpendicular to the surface at the contact point
Position
Orientation
![Page 7: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/7.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
III. FORCE-POSITION CONTROL
+
+
PN
F
DΔF Force
controller
P
ENVIRONMENT
Position
controller
PT-
+
TA
SK
PL
AN
NE
R
Pr
Fr
I-D
+
-
PROBOT
• Hybrid force-position control
‐ Position control law: PI controller
‐ Force control law: elastic interaction model between the robot and the contact surface of stiffness matrix Kx
ΔF = Kx ΔPN
![Page 8: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/8.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
III. FORCE-POSITION CONTROL
• Torque compensation
‐ Rotation by an angle α in theopposite direction of the torque vector
‐ Quaternion-based orientationcontroller
F
Torque
compensation
Δτ Orientation
controller
+
-
Rτd
R
ROBOT
τ
ENVIRONMENT
Surfacez
z
F
α
![Page 9: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/9.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
IV. EXPERIMENTS
• Experiment design
1. Initial stiffness matrix estimation
2. Displacement of the camera robot 10 cm along the y-direction while exerting an 8 N force on the z-direction.
z
y
Barret WAM
Abdomen simulator
![Page 10: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/10.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
III. EXPERIMENTS
- Recurrent Least Square (RLS) algorithm
• Stiffness matrix estimation
![Page 11: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/11.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
III. EXPERIMENTS
- Recurrent Least Square (RLS) algorithm
• Stiffness matrix estimation
![Page 12: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/12.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
III. EXPERIMENTS
• Displacement of the camera robot
![Page 13: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/13.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
III. EXPERIMENTS
• Experimental results: force
- Maximum error = 160 mN
- Sensor resolution = 50 mN
![Page 14: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/14.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
III. EXPERIMENTS
• Experimental results: displacement
- Trapezoidal velocity profile
- Maximum error = 4.5 mm
![Page 15: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/15.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
III. EXPERIMENTS
• Experimental results: orientation
- Maximum error = 2.1 grades
- Mean error = 1.3 grades
![Page 16: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/16.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
III. CONCLUSIONS AND FUTURE WORK
‐ The camera robotic system solves the problem of the loss of triangulation and reduces the number of instruments sharing thesingle port
‐ Hybrid force-position control with torque compensation todisplace the camera robot along the abdominal wall
‐ Online environment stiffness matrix to take into account eachpatient characteristics
‐ Reduce the overall size of the camera robot
‐ Experiments with different contact surfaces
• Conclusions
• Future Work
![Page 17: IROS 2013 - Force-Position Control for a Miniature Camera Robotic System for Single-Site Surgery](https://reader031.vdocuments.mx/reader031/viewer/2022030318/5a6d2f367f8b9ab3418b5e89/html5/thumbnails/17.jpg)
Dep
art
men
t o
f S
ysy
em
En
gin
eeeri
ng
an
d A
uto
mati
on
Víctor F. Muñoz Martínez
Research lines
THANK YOU FOR YOUR ATTENTION