Fixes and breakses

Change how:
* Software Serial transmits data on controller_intermediate
* Software Serial receives data on controller
* Implemented “wait” fix on controller setup for Leonardo