porting from the fbp.
First pass through GraphState, RobotState
Created SwarmState