Richt op het doel

Ontwerp een algoritme dat de blokken [Rijden naar] en [Draai naar richting], de GPS-sensor, de bodemafstandssensor en de inlaatmotorgroep gebruikt om de Hero Bot langs de autonome lijn te laten rijden en zo snel mogelijk de twee groen gemarkeerde schijven in het blauwe hoge doel te lanceren en de twee roze gemarkeerde schijven in het hoge doel te lanceren

• Selecteer de VRC Virtual Skills - Spin Up Playground.
• Rijd met de Hero Bot naar het nulpunt (0, 0) en draai hem richting de groen gemarkeerde schijven.
• Gebruik de bodemafstandssensor om de Hero Bot te besturen en gebruik de innamemotor om de twee groen gemarkeerde schijven één voor één op te nemen. 
• Ontwikkel een algoritme om de richting van de Hero Bot te bepalen, zodat de schijven naar het blauwe doel kunnen worden gelanceerd. Programmeer de robot om naar de aangegeven richting te draaien en de schijven te lanceren.
• Gebruik de onderste afstandssensor om de Hero Bot langs de autonome route te laten rijden, en gebruik de innamemotor om de twee roze gemarkeerde schijven op te pakken.
• Ontwikkel een algoritme om de richting van de Hero Bot te bepalen, zodat de schijven naar het rode doel kunnen worden gelanceerd. Programmeer de robot om naar de aangegeven richting te draaien en de schijven te lanceren.
• Stel een timer in en kijk hoe snel de Hero Bot deze taak kan voltooien.

Handige tips

• De X- en Y-coördinaten van het blauwe hoge doel op de VRC-velden zijn (-1350, -1350).
• De X- en Y-coördinaten van het rode doel op de VRC-velden zijn (1350, 1350).
• Gebruik de GPS-sensor om de huidige X- en Y-coördinaten van de Hero Bot te bepalen. 
• Gebruik de Atan-functie om Theta te berekenen en zet Theta vervolgens om naar de richting van de Hero Bot die nodig is om de schijven te lanceren.