Fix draw_square example

[glannuzel]

Example with goal_position is too jerky, use of goto_joints() instead