Removing the critial section form the FIFO
Make the hystersys only increment if the axis is not moving
The check of arrival at setpoint should take into account the running
state of the PID
Allow the definition of a user data in the flash page
removing useless prints
Changing flash page to end of the chip
Moved the homing code into the PID controller