lots of fixes; robot_state compiles, but more work is needed