Reworked and commented robot program
Reworked display program