Check `is_off()` before all send_goal_positions

[glannuzel]

We check parts are not off before sending goto commands. We should do the same when using send_goal_positions()