modifications to the driver and script based on testing on actual robot