Update and fixes

- fixed memory issue
- mainly the control interface was changed
- added services for extend/retract legs