Fablab ado > déplacement du mbot
Après avoir configuré le mbot, nous avons le souhait qu’il bouge !
voici le premier code arduino créé par Stéphane, notre champion du code :
N.B. : les valeurs "speedmot" sont avec une polarité différente car les moteurs sont inversés.
Dans l’IDE Arduino :
// V1.0 - 25/01/2019
// Stéphane Beurret
#include "MeMCore.h"
#define ledPin 13
#define buttonPin 7
#define leftLed 1
#define rightLed 0
#define NONE 0
#define GAUCHE 1
#define DROITE 2
#define AVANT 3
MeRGBLed led(0, 30);
MeLineFollower lineFinder(PORT_2); /* Line Finder module can only be connected to PORT_2, PORT_4, PORT_5, PORT_6 of base shield. */
MeDCMotor motG(M1); //Motor1 is Left Motor
MeDCMotor motD(M2); //Motor2 is Right Motor
MeBuzzer buzzer;
MeLightSensor lightSensor(PORT_8);
MeUltrasonicSensor ultrasonic(PORT_3);
int oldMove=NONE;
int speedMot=100;
void setup(){}
void loop()
{
//motor.run() maximum speed is 255 to -255, 0 is stop
motG.run(-speedMot); //Motor1 (Left) forward is -negative
motD.run(speedMot); //Motor2 (Right) forward is +positive
delay(1000);
motG.run(speedMot); //Motor1 (Left) forward is -negative
motD.run(-speedMot); //Motor2 (Right) forward is +positive
delay(1000);
motG.stop(); //Stop Motor1
motD.stop(); //Stop Motor1
delay(500);
}
Exercice pour débuter :
analyser le mouvement fait par le robot et lire le code
changer speedmot par des valeurs comprises en -255 et 255 (valeur max),
changer la durée du movement (delay)
faire tourner le robot (avec des valeurs "speedmot" différentes)
faire un parcours
Partager cette page