Added Robot and Box classes. Visualization working. Next Step- inverse kinematics.