bug: the calculation for determinant in ur pure pursuit algorithm is incorrect

[polargh]

Deocde/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/blucru/common/subsytems/drivetrain/sixWheelDrive/purePursuit/PurePursuitComputer.java

Line 40 in a4f0d19

double D = p1.getX()*p1.getX() - p2.getY()*p2.getX();

ur calculation at line 40 should be

d = p1Shifted[0]*p2Shifted[1] - p1Shifted[1]*p2Shifted[0];