skule.sormo.no

Denne programskissen styrer et kjøretøy mot en angitt kompasskurs.

Når ny kompasskurs blir gitt, må kjøretøye dreie enten mot venstre eller høyre , - fortrinnsvis den veien som er kortest, for å fortsette mot den nye kursen.

Kompasskursen oppgis ved hjelp av en IMU som har kompassmodul eller en enkelt HMC5883L-krets som kommuniserer ved hjelp av en I²C-bus. Kjøretøyet har da en en kurs som endres, og nå kjøretøyets retning endres mot den nye kursen. Dette skulle en tro er enkelt, men dersom ny kurs er 10 grader og gjeldende kurs er 340 grader, er det kortest å svinge til høyre, selv om å svinge til venstre reduserer kursen gradvis til 10 grader. Men da har kjøretøyet snurret unødvendig rundt for å komme på den nye kursen.