De volgende Robot lijn met Basic PD (evenredige-derivaat) controle (5 / 6 stap)

Stap 5: Controleren of de regel die volgt op routine


De regel die volgt op routine behandelt de berekeningen en foutafhandeling.

VOID follow_line (int line_position) //follow de lijn

{

switch(line_position)
{

Deze gevallen omgaan met de situatie waar de lijn verloren is en de poging om te draaien naar de lijn

regel heeft verplaatst van de linker rand van sensor
Case 0:

digitalWrite (dir_a, laag);
analogWrite (pwm_a, 200);
digitalWrite (dir_b, hoge);
analogWrite (pwm_b, 200);
Serial.println ("Left\n draaien");
breken;

regel heeft verplaatst uit de juiste bewerking van de sensor
Case 7000:
digitalWrite (dir_a, hoge);
analogWrite (pwm_a, 200);
digitalWrite (dir_b, laag);
analogWrite (pwm_b, 200);
Serial.println ("Right\n draaien");
breken;

Deze regel berekenen de fout voor de lus van de controle. 3500 is de "setpoint" en kan worden aangepast om de positie van de lijn die de robot is schieten voor.

standaard:
fout = (float) line_position - 3500;

de snelheid van de motor op basis van evenredige en afgeleide PID termen instellen
KP is het een drijvende proportionele constante (misschien beginnen met een waarde rond 0.5)
KD is de drijvende afgeleide constante (misschien beginnen met een waarde van ongeveer 1)
Merk op dat wanneer het doen van PID, het is zeer belangrijk dat u uw borden rechts, of anders de
controle lus zullen unstable

Dit zijn de variabelen die moeten worden aangepast om te fine-tunen van de controle-lus

KP =. 5; Dit is de waarde van de proporational
KD = 1; Dit is de afgeleide waarde

PV = kp * fout + kd * (fout - lastError);
lastError = fout;

PWM waarden (motorsnelheid) moet tussen 0 en 255. Deze code beperkt de waarden. Het beperkt ook de lage kant van de PWM-waarde. Afhankelijk van de batterijen, de motoren en de belasting, zal de motoren meestal kraam op een veel grotere waarde de 0. In dit voorbeeld is de low-end 170.

Dit codes grenzen de PV (motorsnelheid pwm waarde)
limiet PV aan 55
Als (PV > 55)
{
PV = 55;
}

Als (PV < -55)
{
PV = -55;
}

Dit berekend de individuele PWM-waarde voor elke motor, Let op het sign verschil.

m1Speed = 170 + PV;
m2Speed = 170 - PV;

motor snelheid instellen

Hiermee stelt u de bijgewerkte motor snelheid en richting

digitalWrite (dir_a, laag);
analogWrite (pwm_a, m2Speed);
digitalWrite (dir_b, laag);
analogWrite (pwm_b, m1Speed);
breken;
}
} / / Volg regel end

Gerelateerde Artikelen

Arduino lijn volgende Robot voor Beginners

Arduino lijn volgende Robot voor Beginners

* Updated GREEN 8 / 2 4 / 2 GREEN 1 voidsetup() {   // a variable created in here doesn't exist in loop } voidloop() {   // a variable created in here doesn't exist in setup } bron wilt opnemen meer prijzen, informatie en bovenkant/bodem/wiel sjablon
Eenvoudige licht volgende Robot

Eenvoudige licht volgende Robot

bouwen van een eenvoudige lichte volgende robot met gemeenschappelijke low-cost delen.  Je moet een soldeerbout, hete lijmpistool en een ohmmeter als er geen overeenkomende lichtsensor cellen.  Deze robot zal volgen licht van een zaklamp.  Deze onder
Robot - lijn volgeling

Robot - lijn volgeling

Ik begon te werken op mijn eerste robot ongeveer twee jaar geleden. Zonder bijzondere reden, heb ik besloten om te beginnen met een lijn volgende robot en de waarheid wordt verteld, mijn eerste poging om het gebouw werd een complete mislukking. Terug
Programma & controle Arduino + PHIRO robot gelijktijdig met Pocket Code smartphone app

Programma & controle Arduino + PHIRO robot gelijktijdig met Pocket Code smartphone app

PHIRO Pro is een educatieve robot die helpt kinderen leren code. Een van de manieren voor het programmeren en besturen van de PHIRO is via een Android app genaamd Pocket Code beschikbaar op Google Play voor gratis. Zak Code heeft de mogelijkheid voor
GSM gebaseerd veelzijdige Robotic voertuig met behulp van PIC Microcontroller

GSM gebaseerd veelzijdige Robotic voertuig met behulp van PIC Microcontroller

dit project is ontworpen als een robot voertuig dat kan worden gecontroleerd door een mobiele telefoons te ontwikkelen. DTMF opdrachten vanaf een telefoon verzenden naar een andere mobiele telefoon die is gemonteerd op de robotic voertuig. Deze opdra
Robot kostuum met LEDs

Robot kostuum met LEDs

de redenen waarom ik wilde maken van een robot die past bij zijn complex. Om een lang verhaal kort, wilde ik een kostuum die ik gebruiken kan om mijn collega's vermaken terwijl ze angstvallig voorbereid voor laatste examens. Maar ik wilde oude kostuu
O-vet de Robot viervoeter met acryl frame

O-vet de Robot viervoeter met acryl frame

Dit is een mini O-vet de viervoeter robot, badrand van 2mm die acryl met de Snijder van de laser knippen.Mini O-vet 2dof kruipt legged robot is, bestaat uit 8 metal gear micro servo, 2 servo in elke voet, voor deze tutorial die i 'm gonna make een on
Licht volgende Robot (Lighttode)

Licht volgende Robot (Lighttode)

enige tijd geleden maakte ik deze lichte volgende robot. Het is een echt eenvoudige robot met eenvoudig delen.Delen:Arduino uno3 photoresistors3 2.2 k weerstandenjumper kabel draden2 servo's (continue 360 rotatie)9V batterijStap 1: Eerste, neem een s
Hoe maak je een robot auto met afstandsbediening.  (Ashwini sinha).

Hoe maak je een robot auto met afstandsbediening. (Ashwini sinha).

remote controlled robotic auto met arm...Stap 1: Dingen die nodig zijn you need-4 speelgoed wielen-1 motorreductor-4 stalen staaf (dunne zoals in pic)-1motor-6 versnelling verminderen-20 cm draadStap 2: Rangschikken de versnelling als in pic.then fix
Ultrasone sensor robot auto met gebruikte motorfiets accu met LCD-scherm

Ultrasone sensor robot auto met gebruikte motorfiets accu met LCD-scherm

Deze robot auto werkt met ultrasone sensor HC-SR04 en met gebruikte 12V motorfiets accu aangedreven.Stap 1: Lichaam van de robot-auto De robot-lichaam met behulp van triplex en een vlak stuk van hout te maken. Snijd de multiplex in een 9 inch door 6
Upgrade uw Mint Plus-iRobot Braava robot mop met behulp van 3D printen

Upgrade uw Mint Plus-iRobot Braava robot mop met behulp van 3D printen

Moe van de batterijpakken falende en betalen de volle prijs te vervangen?Wens dat u kon gemakkelijk Vervang de batterijen door hoogwaardige oplaadbare AA-batterijen?Wenst dat u de werking van uw robot kan uitbreiden zonder wijziging van de slanke loo
Project Robot Bug - met wii nunchuck

Project Robot Bug - met wii nunchuck

Project Robot BugWat de robot moet hebben:Bewegend object, led lichtHet materiaal van de robot moet bestaan uit 3 verschillende soorten materiaal3D printers zijn vereist in het proces van het maken van dit project.Stap 1: Project delen & assemblage s
Gebaar controlled robotic auto met Androïde toepassing

Gebaar controlled robotic auto met Androïde toepassing

FYP - Gesture Controlled Robotic auto met Androïde toepassing. Volledige code inclusief gebaar erkenning en bluetooth gegevensoverdracht is beschikbaar. Volk wie nood elke vorm van hulp met betrekking tot dit project of een ander project (met betrekk
Digilent MRK + lijn-volgende Robot montage-instructies

Digilent MRK + lijn-volgende Robot montage-instructies

OverzichtDe Digilent lijn-volgende Motor Robot Kit (MRK + lijn) biedt de ideale uitvalsbasis voor degenen die nieuw voor Robotica, maar de bevoegdheid heeft om te worden gebruikt voor geavanceerde ontwerpen en toepassingen ook. Het MRK + lijn paren o