Designed a forward and inverse kinematic solver for a robotic arm (ABB IRB-1400) in matlab then put the solver into ROS subscribers to solve any set of joint angles or desired end effector position and orientation published. Programs can be adjusted with frame positions to work with any 6DOF serial robot with revolute joints.
ROS Version ^