Porting SoT to PR2

- Modification of the python robot class
- Integration of modifications from other packages
- Demo scripts