Fixed possible race-condition
Fixed possible race-condition

#550

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