Still not working but i need to pull
Optimisation of the robot program
Improving the display program