Final Arduino code for hexapod