added robot-pose.lisp and defined robot-state class