Fixed the PID algorithm and got rid of the core java elements that FRC doesn't recognize