Complete project-EPOS/IMU/PC work together

Data from IMU and EPOS are sent to PC , C_stop command received from PC,
Motors turn