Monorepo

[kasohrab]

Redoing #156 with only some bare minimum fixes (since when I tested it yesterday radio would not initialize on that branch). And based on how our current debugging setup is, it is faster to redo it all like this..

[kfu02]

works on the one robot we found that works, so we merge