Unofficial TiltyWay V0.2 software port

Ported segway code to TiltyWay. Quick and dirty fix, but functional.