Robotics

(TODO: forward and inverse kinematics of a 6DoF robot arm using homogeneous transformation matrices)