Added dt to PID loop and lowered max motor ouput to 150.