Old Ballbot movement XY
Ang.getPower(newAngleX, newAngleY, currentTime-lastTime); /* if(newAngleX < -4){ motorA.move(forward,0.33); motorB.move(forward,0.28); motorC.move(forward,0.2); }else if (newAngleX > -8 && newAngleX < -1.2){ motorA.move(forward,0.18); motorB.move(forward,0.28); motorC.move(forward,0.2); }else if (newAngleX > 8){ motorA.move(backward,0.33); motorB.move(backward,0.28); motorC.move(backward,0.22); C back has power }else if (newAngleX < 8 && newAngleX > 1.2){ motorA.move(backward,0.18); motorB.move(backward,0.28); motorC.move(backward,0.22); C back has power }else{ motorA.move(backward,0.0); motorB.move(backward,0.0); motorC.move(backward,0.0); }
if(newAngleY > 1.2 && newAngleY < 10){ motorA.move(forward,0.22); motorB.move(backward,0.3); }else if(newAngleY > 10){ motorA.move(forward,0.3); motorB.move(backward,0.4);
}else if (newAngleY < -1.2 && newAngleY > -10){ motorA.move(backward,0.22); motorB.move(forward,0.3); }else if (newAngleY < -10){ motorA.move(backward,0.3); motorB.move(forward,0.4); }else{ motorA.move(backward,0.0); motorB.move(backward,0.0); motorC.move(backward,0.0); }*/
Please log in to post comments.