Added some sample code for simultaneous rotation of motors
Added function for drawing env data