New code for motor directions and buggy program

Once the final assembly was carried out the final changes were made into the program:

Motor directions



Pen-ultimate program (ready to be assessed by the group and approved by the project manager)