Svenska ElektronikForumet

Du har ju ungefär att:
X = A*cos(vinkel)+B
Y = C*sin(vinkel)+D
Där A, B, C och D är konstanter.
B och D är ju medelvärdet, och A och C är amplituden.

Räkna om X och Y så att de går mellan -1 och +1. Då kan du räkna ut vinkel som arctan(Y/X).
Titta på funktionen atan2 så slipper du problem med division med noll om X är nära noll.

Tack för svaret

Från sensorn så är både X och Y koncentrerade runt 0, jag la på lite på varje värde för att göra alla positiva när jag gjorde kurvan(lite onödigt iofs). Om jag ska skala om så att X och Y går från -1 till 1 så måste jag alltså dividera med deras respektive max-värde?
Går det att göra något liknande detta: Detta borde kalibrera den om man kör runt ett varv och sedan kalibrera ytterligare under användning eller är det bättre att kalibrera en gång och sen låta det vara så för att undvika att den "över-kalibrerar"?
Jag är dock lite osäker eftersom det lästa värdet är i 2-komplementsform och jag måste ju även ta negativa max i beräkning. Är jag på rätt spår?

2-komplement är ju just heltal med förtecken så det är inte mycket att spekulera på.

Att göra om det till flyttal är enkelt.
Att räkna ut verkliga vinkeln baserat på X och Y ska väl inte heller vara ett problem, det finns formler för det.

Att "kalibrera" den på det vis du visar känns helt fel, det finns fasta värden som är ±max, använd dom.
Lite bra att veta 1
Lite bra att veta 2

Funktionen atan2 tar två argument, just för att hantera fallet då X eller Y är noll och också de 4 kvadranterna korrekt.
Vinkel = atan2(Y, X)

OMG it works! Tack så mycket! Men är det rätt att värdet från sensorn (som är i 16-bitars tvåkomplementsform) läses in i MagX(som är en int) och att den sedan kopieras in i DirectionX(som är en float)?
Sen är det lite konstigt även om det kvittar, men Direction 0 och Direction 180 ligger inte 180 grader ifrån varann utan snarare 90 grader ifrån varann. Spannet 0-180 ligger dock fint fördelat både på plus- och minus-sidan. Gör jag nått fel eller ska det vara så?

Vad får du för värden på MagX och MagY för de fyra väderstrecken? Och vad får du för värde på Direction för dessa fyra fall?

Om jag utgår ifrån att max-värdet på X motsvarar norr, vilket det verkar göra så blir det ungefär såhär:

X109 Y-26
X0 Y18
X-65 Y-91
X54 Y-137

Ser ju ganska mystiskt ut men det ligger i den regionen och är väldigt repeterbart när man återkommer till samma vinkel.

Värdena du får ser ju skumma ut. I grafen du visade tidigare var ju Y kring mittvärdet då X var min eller max, och X kring mittvärdet då Y var min eller max, vilket är precis som det ska!
Men värdena du visar följer inte detta mönster nu!
Kan du samla in mätvärden på samma sätt som du gjorde då du plottade grafen?

Det är värdena från grafen, det blir så om man drar ifrån dom 256 som jag la på där förut. Kurvorna blir likadana. Mycket skumt.
Men jag blir färdig med båten hårdvarumässigt imorgon så nästa vecka kommer det bli testning och försök att programmera den så jag kan ta nya mätvärden när båten faktiskt kör som det är tänkt med all övrig elektronik inkopplad.

Edit: Noterade nu att X pendlar kring ett värde högre än 0 och Y kring ett värde som är lägre än 0. Det är ju förmodligen det som gör skillnaden, är det måhända bara att "flytta" X neråt och Y uppåt för att det ska bli rätt? Frågan är ju varför det är så alls men det kanske inte är så bra sensor?
Det är en switch-regulator från 12V-batteriet --> 5 V och sen är det en linjär regulator från 5 --> 3.3V som driver sensorn.

Justerar du dem så att de pendlar hyffsat symmetriskt kring noll så kommer det nog bli mycket bättre beräknade värden...

Jag ska prova det så får vi se

En fråga till, varför ger detta varningen att jag jämför en signed med en unsigned integer: Jag vill jämföra värdet i OCR1A med (Steering_Set + STEERING_OFFSET) och värdet i OCR1A kan ju inte vara signed, så vad jämför jag egentligen med i koden?

Edit: Hmmm...hjärnsläpp som vanligt. int16_t är ju signed

Jag ämnar testa båten idag eller imorgon men har en liten fundering.
Är det möjligt att i ett interrupt sätta ett nytt ställe i programmet att fortsätta ifrån efter avbrottet?

Jag såg att det fanns en avbrotts-vector för watchdog-timern. Min tanke var om jag i det avbrottet skulle kunna tala om att den ska fortsätta på annat ställe efteråt samt eventuellt tända en LED som indikering att avbrott har inträffat. På så vis borde buggar som gör att programmet hänger sig inte göra att båten slutar fungera. Mitt manuella läge funkar, men det förutsätter att jag även kan växla till manuell från auto, och det går ju inte om programmet hängt sig i auto.
Det är mest för att minska risken för ”runaways” lite. Jag vill helst inte att den gör reset utan skulle bara vilja välja nytt ställe i min huvudloop att fortsätta ifrån.

Det ska gå att göra det - men det är extrem dålig programmeringsskick.

Det finns dock ett stort problem som är att du vill göra det i en interrupt. Då måste du rulla av returadressen från stacken, rulla in den "rätta" och sedan lämna interrupten. Det kan finnas andra värden på stacken som kan ge problem.

Men om du gör så usla program att de hänger sig är det mycket bättre att göra bättre program. Det är ju DU som styr om uträkningar kan riskera hänga sig så DU kan också avgöra när det finns risk för detta och då göra en "räddning".

Problemet är att det är svårt att testa båten utan att släppa iväg den och då känns det bättre att använda en watchdog-timer om det går. Det är inte programmeringsfel jag vet om som jag ska rädda, utan fel jag inte vet om.
Men om det inte finns något "inbyggt" sätt att ändra retur-adress från avbrottet så får det bli en vanlig reset hellre än inget alls, då kan jag hur som helst få tillbaka manuell kontroll oavsett om programmet hänger sig

Jungfruturen gick galant Manuellt läge funkar utmärkt men auto-läge kunde jag dock bara dutta lite på eftersom jag inte har programmerat den mer än att köra rakt med hjälp av GPS:en och kompassen.
Den gick väldigt rakt och stabilt på plattvatten men det återstår att se hur den klarar vågor.