Afbeeldingen met de rotatie van de spline zelf op 0, zoals je kan zien worden de innergates geroteerd op basis van de rotatie van de volgende gate.
Zoals je hieronder kan zien gebeurt dit ook wanneer je de spline zelf roteerd, de positie wordt altijd goed aangegeven.
Het algoritme heeft mij uiteindelijk best veel rekenwerk gekocht, de meest simpele manier om dit voor elkaar te kregen was om uiteindelijk de gate zelf als een frame of reference te gebruiken. Wat ik had gedaan was de coördinaten van de volgende gate van de huidige gate afgehaald en die waarde vervolgens in een coördinaten systeem te stoppen met als nulpunt de gate zelf. Om die coördinaten goed te berekenen heb ik gebruik gemaakt van het volgende algoritme: http://keisan.casio.com/exec/system/1223522781
Hierdoor kon ik op basis van de rotatie van de gate zelf de juiste positie van de andere gate berekenen met als nulpunt de huidige gate. Binnen het coördinaten stelsel zelf kon ik de hoek berekenen naar de volgende gate op basis van de acos in graden. Dit gaf altijd een hoek terug tussen de -180 en 180 graden, dat was precies wat ik nodig heb om te weten waar de volgende gate stond.
Door dit toe te passen heb ik er voor kunnen zorgen dat ik altijd de juiste yaw van een euler terug krijg naar de volgende gate. Met de hoek die daar uitkwam heb ik uiteindelijk de innergate rotatie juist kunnen zetten op basis van de thermal en de rotatie naar de andere gate toe.
Morgen heb ik een afspraak met mijn begleider binnen het bedrijf en ga ik mijn PID/projectplan volledig afronden.




Geen opmerkingen:
Een reactie posten