Paul Jones
232d39b19d
* Using 8 bits per int for serial devices * Refactor simwind code slightly to improve performance
44 lines
916 B
Arduino
44 lines
916 B
Arduino
#include <Adafruit_MotorShield.h>
|
|
#include "simwind.h"
|
|
|
|
#define BYTE_SIZE sizeof(SimWindData)
|
|
#define KPHTOMPH .621317
|
|
#define FANPOWER .6
|
|
|
|
Adafruit_MotorShield AFMS = Adafruit_MotorShield();
|
|
|
|
Adafruit_DCMotor *myMotor1 = AFMS.getMotor(1);
|
|
Adafruit_DCMotor *myMotor2 = AFMS.getMotor(3);
|
|
|
|
SimWindData sd;
|
|
int velocity = 0;
|
|
|
|
void setup() {
|
|
Serial.begin(9600);
|
|
if (!AFMS.begin()) {
|
|
Serial.println("Could not find Motor Shield. Check wiring.");
|
|
while (1);
|
|
}
|
|
sd.velocity = 10;
|
|
|
|
myMotor1->setSpeed(0);
|
|
myMotor1->run(FORWARD);
|
|
|
|
myMotor2->setSpeed(0);
|
|
myMotor2->run(FORWARD);
|
|
}
|
|
|
|
void loop() {
|
|
char buff[BYTE_SIZE];
|
|
|
|
if (Serial.available() >= BYTE_SIZE)
|
|
{
|
|
Serial.readBytes(buff, BYTE_SIZE);
|
|
memcpy(&sd, &buff, BYTE_SIZE);
|
|
velocity = sd.velocity;
|
|
}
|
|
|
|
myMotor1->setSpeed(velocity*FANPOWER);
|
|
myMotor2->setSpeed(velocity*FANPOWER);
|
|
}
|