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.