Added set_semi_period to Counter, got 3/4 autonomous modes working, got basic_navigator working, lots of other stuff.