Forward and Inverse kinematics for hand made robot to follow aruco marker (position and orientation)
calculate forward and inverse kinematics for scara robot (5DOF) to get to the aruco marker position and orientation. using mathplotlib to generate gui and present 3D real time simulation and camera frame.