function added to Stage to convert from Stage coordinates to ROS coordinates
NavigationArrow added
conversion from ros orientation to global theta addeD