Added more specific TODO's in the 'servostock_velInverse' function based
on Matlab notes.
Updated parameter list to 'servostock_velInverse' function.