void right(int speed) {
DigitalWrite(D4, false);
DigitalWrite(D2, false);
DigitalWrite(D5, true);
DigitalWrite(D7, false);
AnalogWrite(PWM3, speed);
AnalogWrite(PWM6, speed);
}
void playTone(int tone, int duration) {
for (long i = 0; i < duration * 1000L; i += tone * 2) {
DigitalWrite(D8, true);
delayMicroseconds(tone);
DigitalWrite(D8, false);
delayMicroseconds(tone);
}
}
void stop() {
DigitalWrite(D4, false);
DigitalWrite(D2, false);
DigitalWrite(D5, false);
DigitalWrite(D7, false);
AnalogWrite(PWM3, 0);
AnalogWrite(PWM6, 0);
}
void forward(int speed) {
DigitalWrite(D4, false);
DigitalWrite(D2, true);
DigitalWrite(D5, false);
DigitalWrite(D7, true);
AnalogWrite(PWM3, speed);
AnalogWrite(PWM6, speed);
}
void backward(int speed) {
DigitalWrite(D4, true);
DigitalWrite(D2, false);
DigitalWrite(D5, true);
DigitalWrite(D7, false);
AnalogWrite(PWM3, speed);
AnalogWrite(PWM6, speed);
}
int ultrasonicSensor() {
DigitalWrite(A5, false);
delayMicroseconds(2);
DigitalWrite(A5, true);
delayMicroseconds(10);
DigitalWrite(A5, false);
float duration = PulseIn(A4, true, 1000000);
float distance = duration/58;
return distance;
}
void setup()
{
initBoard();
float s0 = 0;
while(true)
{
s0 = AnalogRead(sensor0);
DigitalWrite(D13_LED, true);
delay((s0*5));
DigitalWrite(D13_LED, false);
delay((s0*5));
}
}
void setup()
{
initBoard();
while(true)
{
if(DigitalRead(D14))
{
DigitalWrite(D14, true);
toneWithDelay(BuzzerPin, NOTE_E4, 100);
}
else
{
DigitalWrite(D14, false);
}
}
}
void blink_test()
{
int sw=getBootSW();
int ledon=0;
if(sw) {
ledon=1;
}
DigitalWrite(BOARD_LED_PIN,ledon);
}
String WirelessControl::parseStart(int command, int pin, int value)
{
Serial.println(command);
Serial.println(pin);
Serial.println(value);
if(command == 1)
{
DigitalWrite(pin, value);
}
}
