fix Getup. Warning: not tested on robot yet.

Signed-off-by: josiahw <merlz42@gmail.com>