Added a drawing facility to RoboViz