3-SemesterProjekt This is the code I made with my group for our 3rd semester project on our Robotics study