Added fix for when motor controller is timing out. Basically if it already is still when receiving a still action, the encoder callback is never called and then the action doesnt finish. So now a check is made if the callback hasnt been called for a period of time