[BUG FIX] Fix some errors in new control law, which were causing runtime exceptions
- add rpc commands "go down" and "go up" to set at the same time the references for CoM and hand
- add some debug prints