Make primitives explicitly track arm position target instead of relying on zero action

[cgokmen]

Currently in primitives we do NOT track our current desired position for the arm when doing other things, and rely on zero actions. What this means is that if there is any arm movement due to external effects like object weight etc we will NOT attempt to counter it. Instead, we should keep track of the goal and try to return to it even if the hand is moved away.