Timing Changes

Ensure loop takes same amount of time each iteration
- currently can only run the code as fast as 20Hz