Change main loop delay to 10 ms

Delay is only for testing, should be replaced with PID tuning