adding robot state parameter
minor changes due to addition of teleoperation