Created Active Brake Function

Modularized driveTask into activeBrake and driveMove to control braking
and moving. Created PID loop to hold y=x axis still during activeBrake.
Created and initialized encoders for drive.