Improved arm_movement
now it can also read current arm positions
add grip action