#define RMP 10
#define RMN 11
#define LMP 12
#define LMN 13
void setup() {
pinMode (LMP, OUTPUT);
pinMode (LMN, OUTPUT);
pinMode (RMP, OUTPUT);
pinMode (RMN, OUTPUT);
Serial.begin(9600);
}
void loop() {
if (Serial.available() <= 0) return;
String str = Serial.readString();
motor((uint8_t)strtol(str.c_str(), NULL, 2));
}
void motor(uint8_t states) {
digitalWrite(LMP, (states >> 0) & 0x01);
digitalWrite(LMN, (states >> 1) & 0x01);
digitalWrite(RMP, (states >> 2) & 0x01);
digitalWrite(RMN, (states >> 3) & 0x01);
}