Changes to Overall Sampling Frequency for PID

Increased to 50Hz... Maxed out frequency based on the computations in
our loops... UART/Terminal will now break things...