Wanting to add an accel and decel function to a Motor Controller