Added new static poses and implemented the Pick-Up Function

Signed-off-by: Andoni Aguirrezabal <aaguirrezabal@live.com>