RobotArmS

Implemented a 5 jointed robot forward/inverse kinematics with Eigen and Matplotlib cpp wrapper for visuals. Developing state estimation and possible Kalman filtering/calibration of robot.