-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathsoundtodc.ino
87 lines (72 loc) · 2.76 KB
/
soundtodc.ino
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
/*
Make a DC Motor Move to Sound.
This example code is in the public domain.
Created by Donald Bell, Maker Project Lab (2016).
Based on Sound to Servo by Cenk Özdemir (2012)
and DCMotorTest by Adafruit
*/
// include the Adafruit motor shield library
#include <Wire.h>
#include <Adafruit_MotorShield.h>
#include "utility/Adafruit_MS_PWMServoDriver.h"
// Create the motor shield object with the default I2C address
Adafruit_MotorShield AFMS = Adafruit_MotorShield();
// Or, create it with a different I2C address (say for stacking)
// Adafruit_MotorShield AFMS = Adafruit_MotorShield(0x61);
// Select which 'port' M1, M2, M3 or M4. In this case, M1 for mouth and M2 for tail
Adafruit_DCMotor *myMotor = AFMS.getMotor(1);
Adafruit_DCMotor *myOtherMotor = AFMS.getMotor(2);
// Some other Variables we need
int SoundInPin = A0;
int LedPin = 12; //in case you want an LED to activate while mouth moves
// the setup routine runs once when you press reset:
void setup() {
Serial.begin(9600); // set up Serial library at 9600 bps
AFMS.begin(); // create with the default frequency 1.6KHz
//AFMS.begin(1000); // OR with a different frequency, say 1KHz
// Set the speed to start, from 0 (off) to 255 (max speed)
myMotor->setSpeed(0); //mouth motor
myMotor->run(FORWARD);
// turn on motor
myMotor->run(RELEASE);
pinMode(SoundInPin, INPUT);
pinMode(LedPin, OUTPUT);
myOtherMotor->setSpeed(0); //tail motor
myOtherMotor->run(FORWARD);
// turn on motor
myOtherMotor->run(RELEASE);
pinMode(SoundInPin, INPUT);
}
// the loop routine runs over and over again forever:
void loop() {
uint8_t i;
// read the input on analog pin 0:
int sensorValue = analogRead(SoundInPin);
// we Map another value of this for LED that can be a integer betwen 0..255
int LEDValue = map(sensorValue,0,512,0,255);
// We Map it here down to the possible range of movement.
sensorValue = map(sensorValue,0,512,0,180);
// note normally the 512 is 1023 because of analog reading should go so far, but I changed that to get better readings.
int MoveDelayValue = map(sensorValue,0,255,0,sensorValue);
// maping the same reading a little bit more down to calculate the time your motor gets
if (sensorValue > 10) { // to cut off some static readings
delay(1); // a static delay to smooth things out...
// now move the motor
myMotor->run(FORWARD);
for (i=140; i<255; i++) {
myMotor->setSpeed(i);
}
//for (i=200; i!=0; i--) {
// myMotor->setSpeed(i);
// delay(10);
// }
analogWrite(LedPin, sensorValue);
// and do that move in this delay time
myMotor->run(RELEASE);
myOtherMotor->run(RELEASE);
delay(1);
} // Done.
// turn off the led again.
analogWrite(LedPin, 0);
// and this repeats all the time.
}