BeneluxSpoor.net forum
Vraag en antwoord => Elektronica en analoog => Topic gestart door: 72sonett op 27 January 2017, 21:13:03
-
Naar aanleiding van een opmerking in het Mardec topic (http://forum.beneluxspoor.net/index.php/topic,68257.msg3221719389.html#msg3221719389) over het omzetten van wissels met een stappenmotor, heb ik als proof of concept wat uitgeprobeerd volgens dit schema;
(https://images.beneluxspoor.net/bnls/tinymardec.jpg)
De processor is een Basic Stamp BS2sx, deze kijkt naar de eindschakelaar en de signaalpin waar de Mardec/Arduino op zit. Ook gaan er 4 uitgangen via een ULN2003 naar een goedkoop stappenmotortje (https://nl.aliexpress.com/item/5V-stepper-motor-with-ULN2003-driver-board/32761755625.html). De LEDs (in een LEDdisplay) zijn niet nodig maar geven aan welke fasen van de stappenmotor worden aangestuurd.
Een schakelaartje simuleert het H/L Mardec signaal.
De eindschakelaar en de puntstukschakelaar zitten op de stappenmotor geschroefd en worden samen ingedrukt. Aan de as van de stappenmotor moet dan nog een stangetje naar de wissel.
Het programma doet niets anders dan naar de Arduinopin kijken of deze 0 (L=links) of 1 (H=rechts) is en of dit overeenkomt met de actuele wisselstand. Als dit niet zo is wordt de stappenmotor een halve slag naar links of naar rechts verdraaid.
Dat ziet er dan zo uit:
https://www.youtube.com/v/oayCW41L008
Dit is het programma;
' {$STAMP BS2sx}
' {$PBASIC 2.5}
'
' -----[ I/O Definitions ]-------------------------------------------------
fasepins VAR OUTA ' fase output pins 0,1,2,3
arduinopin PIN 4 ' signaal wissel L/R van Arduino
schakelpin PIN 5 ' terugkoppeling, schakelaar voor motor in nulstand
' -----[ Constants ]-------------------------------------------------------
stepdelay CON 5 ' delay voor draaisnelheid
vertraging CON 64 ' ingebouwd in stappenmotor
stappenperrondje CON 64 ' 360/11,25 graden = 32 stappen, x vertraging = 2048 stappen per omw
links CON 0 ' wisselstanden
rechts CON 1
' -----[ Variables ]-------------------------------------------------------
index VAR Word ' stappenteller
halfrondje VAR Word ' aantal stappen voor halve asomwenteling
fase VAR Nib ' fase index
stepsFT VAR Nib(4) ' fasen Full Torque; 2 spoelen, trekt meer stroom
stepsLT VAR Nib(4) ' fasen Low Torque; 1 spoel, minder stroom
stepsHS VAR Nib(8) ' fasen Half Step; langzamer maar nauwkeuriger
wisselstand VAR Bit ' actuele wisselstand
' -----[ step data ]-----------------------------------------------------
stepsFT(0) = %1100 ' fasen Full Torque
stepsFT(1) = %0110
stepsFT(2) = %0011
stepsFT(3) = %1001
stepsLT(0) = %1000 ' fasen Low Torque
stepsLT(1) = %0100
stepsLT(2) = %0010
stepsLT(3) = %0001
stepsHS(0) = %1000 ' fasen Half Step
stepsHS(1) = %1100
stepsHS(2) = %0100
stepsHS(3) = %0110
stepsHS(4) = %0010
stepsHS(5) = %0011
stepsHS(6) = %0001
stepsHS(7) = %1001
' -----[ Initialisatie ]--------------------------------------------------
DIRA = %1111 ' maak P0..P3 output
DIRB = %0000 ' maak P4..P7 input
fase = 0 ' set willekeurige fase index
halfrondje = vertraging * stappenperrondje / 2 ' 32 * 64 /2 = 1024 stappen
GOSUB beginstand ' draai rechtsom totdat schakelaar ingedrukt
PAUSE 100 ' even wachten
' -----[ Main ]-----------------------------------------------
' kijk wat de arduinopin aangeeft, vergelijk met acuele
' wisselstand en zet wissel om naar gewenste stand
DO
IF (arduinopin = links) AND (wisselstand = rechts) THEN GOSUB draailinksom
IF (arduinopin = rechts) AND (wisselstand = links) THEN GOSUB draairechtsom
' anders L=L of R=R, niets doen
LOOP
' -----[ Subroutines ]-----------------------------------------------------
'
beginstand: ' draai rechtsom tot schakelaar ingedrukt = 0
DO WHILE schakelpin = 1
fase = (fase + 1) // 4 ' wijs naar volgende stap (modulus 4)
GOSUB DoStepLT ' draai motor één stap
LOOP ' schakelaar ingedrukt = beginstand = wisselstand R
wisselstand = rechts ' nieuwe wisselstand bereikt
RETURN
'-------------------------
draailinksom: ' draai halve slag linksom
FOR index = 1 TO halfrondje
fase = (fase + 3) // 4 ' wijs naar vorige stap
GOSUB DoStepLT
NEXT
fasepins = %1111 ' motor stroomloos
wisselstand = links ' nieuwe wisselstand bereikt
RETURN
'-----------
draairechtsom: ' draai halve slag rechtsom
FOR index = 1 TO halfrondje
fase = (fase + 1) // 4 ' wijs naar volgende stap
GOSUB DoStepLT
NEXT
fasepins = %1111 ' motor stroomloos
wisselstand = rechts ' nieuwe wisselstand bereikt
RETURN
'-----------
' stuur fase naar output pins (Low Torque)
DoStepLT:
fasepins = stepsLT(fase) ' output fase bits 0..3
PAUSE stepDelay ' pause tussen stappen
RETURN
'-----------
' stuur fase naar output pins (Full Torque)
DoStepFT:
fasepins = stepsFT(fase) ' output fase bits 0..3
PAUSE stepDelay ' pause tussen stappen
RETURN
-
@72sonett,
Fijn dat je een apart draadje hebt geopend. Met de aansluiting van de Arduino, bedoel je denk ik het aansluiten op een van de pinnen van het Mardec Shield. Is hiermee het in de Mardec draad genoemde bezwaar dat niet altijd duidelijk is wat de beginstand is van de stappenmotor geëlimineerd?
Gr, Hans
-
Met zo'n drivertje kun je met drie signalen de motor ook perfect aansturen.
https://www.martoparts.nl/A3967-V44-EasyDriver
Je kunt zelf tot micro step gaan zonder zelf patronen te moeten maken.
Een kloksignaal, richtingssignaal en enable/disable....
Positie zou je dan moeten tellen door interrupt te zetten op timer die het kloksignaal maakt...
Zou je zelfs meerdere stappenmotors kunnen aansturen.....
In het verre oosten zullen de printen nog wel goedkoper zijn :)
Mvg
Robert
-
...Met de aansluiting van de Arduino, bedoel je denk ik het aansluiten op een van de pinnen van het Mardec Shield. Is hiermee het in de Mardec draad genoemde bezwaar dat niet altijd duidelijk is wat de beginstand is van de stappenmotor geëlimineerd?
Ja & ja.
De Mardec maakt die pin hoog (1) of laag (0) om aan te geven of de wissel naar rechts of links moet staan.
Bij inschakelen draait de motor eerst helemaal naar rechts totdat een microschakelaartje wordt ingedrukt (signaal gaat van 1 naar 0). De stappenmotor moet dan zo gemonteerd worden dat de wissel dan ook in stand rechts staat.
Als je voor de processor een Arduino neemt, of een ATtiny of een Picaxe (http://www.picaxe.com/What-Is-PICAXE) of iets soortgelijks, kost het hele spul nog geen 10 euro.
De processor die ik voor deze test gebruikt heb is een Basic Stamp (https://www.parallax.com/product/bs2-ic), omdat ik die nu eenmaal heb en veel makkelijker te programmeren vind dan een Arduino (Basic vs C++), maar de goedkoopste versie daarvan kost ca US$50, dus dat is geen optie.
Bovendien vind ik de oplossing met een stappenmotor helemaal een doodlopend spoor; de aansturing is ingewikkelder dan met een servo of elektromotortje met wat microschakelaartjes. Zoals in het Mardec topic al aangegeven kun je veel makkelijker en goedkoper die I2C 16-servokaart gebruiken.
Met zo'n drivertje kun je met drie signalen de motor ook perfect aansturen.
https://www.martoparts.nl/A3967-V44-
Maar die is voor bipolaire stappenmotoren, die in mijn voorbeeld is een unipolaire, met andere aansturing :'(