https://medium.com/@jamesrodrigueswise2/robotics-msc-assignment-homework-help-middlesex-university-uk-1ee367895a04