added outline to draw_box
Draw actuator
added conversions between degrees and radians
added basic transformation matrix functions. will probably mostly be replaced by numpy, but wanted to try.
updated robot_to_world to work in 3d, viz_2d.py now broken
moving actuator around with robot body
draw_actuator converts to world coordinates before drawing