Changed comments
Motors are now reset and FPGA image sent only when all motors are stopped, and max once in 30 seconds
Converted C++ syntax to C
Refactored dangerous code
Fixed a bug in all_motors_stopped handling
Merge branch 'ahti-work-in-progres'