- Added some control of robots
- Reviewed struct of robot
- Simplified operation