Reorganize and optimize

- Move calculate and updateUI to main loop
- Change around how speed is calculated and updated
- Remove antenna output