float rightSimpleMilliDegreeAndWait(float angleMilliDegree) {
rightSimpleMilliDegree(angleMilliDegree);
handleAndWaitFreeMotion();
return -angleMilliDegree;
}
float leftSimpleMilliDegreeAndWait(float angleMilliDegree) {
leftSimpleMilliDegree(angleMilliDegree);
handleAndWaitFreeMotion();
return angleMilliDegree;
}
void rightSimpleDegreeAndWait(PidMotion* pidMotion, float angleDegree, OutputStream* notificationOutputStream) {
rightSimpleDegree(pidMotion, angleDegree, notificationOutputStream);
handleAndWaitFreeMotion(pidMotion, notificationOutputStream);
}
float backwardSimpleMMAndWait(float distanceInMM) {
backwardSimpleMM(distanceInMM);
handleAndWaitFreeMotion();
return distanceInMM;
}
void backwardSimpleMMAndWait(PidMotion* pidMotion, float distanceInMM, OutputStream* notificationOutputStream) {
backwardSimpleMM(pidMotion, distanceInMM, notificationOutputStream);
handleAndWaitFreeMotion(pidMotion, notificationOutputStream);
}