Positionering van stappenmotoren in X en Y met behulp van een subroutine

 

Deze subroutine biedt een eenvoudige manier om te bewegen op verschillende coördinaten in een 2D-zone (X en Y).

• GotToX en GoToY zijn de coördinaten waar je naartoe wilt.
• SpeedMax is de maximale snelheid van X en/of Y. Indien nodig wordt een tweede snelheid berekend om tegelijkertijd bij de coördinaten aan te komen.
• Done=1 zodra de coördinaten zijn bereikt.
• CurrentLocation geeft je in realtime de locatie van elke as.
• SoftStartStop geeft aan hoe lang het duurt voordat de snelheid is bereikt

Een korte video over wat je eenvoudig kunt doen met deze subroutine

In de subroutine zie je verschillende stappen

• Stap 0
  • Op hetzelfde moment aankomen in X en Y. Berekening van de snelheid voor de langzaamste as.
• Stap 1
  • We starten beide stappenmotoren.
• Stap 2
  • We wachten op het einde van de beweging.

Bij elke stap verlaten we de subroutine om het hoofdprogramma verder te laten gaan.

Het hoofdprogramma is er als voorbeeld

We gebruiken een tabel voor elke coördinaat.

En we roepen de subroutine

Je kunt de subroutine hierdownloaden