Update PIDDriver.cpp

some changes in the method getGear()