Modified and improved version of stabyourself.net's OrthoRobot