add state machine robot_control package and update serial_comm with object-oriented design changes
test state machine with terminal