Added real-time graphical representation of robot pose