Thesis robot control

Thesis robot control