robotteach package can write the robot state into the txt