Drie Low-Cost verwisselbare 3D-printbaar Bionic handen (11 / 13 stap)

Stap 11: Hoge snelheid Hand (vervolg) - Arduino Software

Eenvoudige b.v. om te testen uw DC-motoren van uw hand - bibliotheek moet worden gedownload van Adafruit motor shield versie 1

Adafruit Motor shield bibliotheek

Deze code is het publieke domein, enjoy!

#include

DC-motor op M1234

AF_DCMotor motor1(1);

AF_DCMotor motor2(2);

AF_DCMotor motor3(3);

AF_DCMotor motor4(4);

int potpin1 = 0; analoge pin gebruikt voor het aansluiten van de potentiometer

int potpin2 = 1; analoge pin gebruikt voor het aansluiten van de potentiometer

int potpin3 = 2; analoge pin gebruikt voor het aansluiten van de potentiometer

int potpin4 = 4; analoge pin gebruikt voor het aansluiten van de potentiometer

int val1; variabele te lezen van de waarde van de analoge pin

int val2; variabele te lezen van de waarde van de analoge pin

int val3; variabele te lezen van de waarde van de analoge pin

int val4; variabele te lezen van de waarde van de analoge pin

VOID Setup

{

Serial.begin(9600); instellen van seriële bibliotheek 9600 bps

Serial.println ("Motor partij!"); inschakelen motor 1234 - (255 is topsnelheid)

motor1.setSpeed (255);

motor1.run(release);

Motor2.setSpeed (255);

Motor2.run(release);

motor3.setSpeed (255);

motor3.run(release);

motor4.setSpeed (255);

motor4.run(release); }

void loop

{val1 = analogRead(potpin1); / / leest de waarde van de potentiometer (waarde tussen 0 en 1023)

val1 = kaart (val1, 0, 1023, 0, 180); schaal om het te gebruiken met de servo (waarde tussen 0 en 180)

Serial.println(val1);

Als motor1.run(FORWARD) (val1 > 95); motor uit volgens de geschaalde waarde

Als motor2.run(FORWARD) (val1 > 95); motor uit volgens de geschaalde waarde

Als motor3.run(FORWARD) (val1 > 95); motor uit volgens de geschaalde waarde

Als motor4.run(FORWARD) (val1 > 95); motor uit volgens de geschaalde waarde

vertraging (15);

motor1.run(release);

Motor2.run(release);

motor3.run(release);

motor4.run(release);

Als (val1 < 85) motor1.run(BACKWARD);

Als (val2 < 85) motor2.run(BACKWARD);

Als (val3 < 85) motor3.run(BACKWARD);

Als (val4 < 85) motor4.run(BACKWARD);

vertraging (15);

motor1.run(release);

Motor2.run(release);

motor3.run(release);

motor4.run(release);

}