Demo 6

See the description here: https://github.com/MandyMeindersma/Robotics/blob/master/Demos/Demo6/Demo6Description.pdf

Code for part 1 & 2:

• https://github.com/MandyMeindersma/Robotics/tree/master/Demos/Demo6

We were unable to complete part 3.