So I messed up somewhere in the equations for odometry.
int posTask(){ //deltaS is the distance between both points //alpha is the change in rotation doub