Remove buffer overflow check, to add in in a better manner later.
Speed up main loop by not checking for commands when sending data.

TODO- How does this affect stop?
Reindent dspi.c to project standard.
Change PWM width to a more sensible value.
Properly check CONFIG macros in TEST_HW mode.
Add some optimisation.