float forwardSimpleMMAndWait(float distanceInMM) {
    forwardSimpleMM(distanceInMM);
    handleAndWaitFreeMotion();
    return distanceInMM;
}
void forwardSimpleMMAndWait(PidMotion* pidMotion, float distanceInMM, OutputStream* notificationOutputStream) {
    forwardSimpleMM(pidMotion, distanceInMM, notificationOutputStream);
    handleAndWaitFreeMotion(pidMotion, notificationOutputStream);
}