Rome robot excercise

Dependencies:   PM2_Libary Eigen