https://medium.com/@rodigo3538/beng-robotic-engineering-assignment-homework-help-university-of-essex-uk-8dc3d4e52286