https://medium.com/@jamesrodrigueswise3/msc-robotics-and-autonomous-systems-assignment-homework-help-edinburgh-napier-university-uk-085177709e71