Fixed bug where heading is horizontal
Don't bother with 0MQ for now
Coroutine bug fixed