fix float literals, safer margin, extra instruction
fix float literals, safer margin, extra instruction

madcowswe/ODrive,madcowswe/ODrive,madcowswe/ODrive,madcowswe/ODriveFirmware,madcowswe/ODrive,madcowswe/ODriveFirmware,madcowswe/ODrive,madcowswe/ODriveFirmware,madcowswe/ODriveFirmware