Debug of a comm error, joints are read now when resetting.