Update angularPositionPID.cpp to use absolute angle

I changed the code to use the gyro angle instead of gyroRaw angle. I limit the rotation rate to 500.