https://medium.com/@jamesrodrigueswise3/robotics-msc-assignment-homework-help-university-of-sheffield-uk-e70eee913b26