Fix helpFindSign (floats don't have signs....)
Fix bugs in drive, add debugging lines
Fix calculations of slew rates