mirror of
https://github.com/digistump/DigistumpArduino.git
synced 2025-04-27 23:29:01 -07:00
Add more examples - fix robot example
This commit is contained in:
parent
f92e829acd
commit
d8e0256a91
@ -0,0 +1,22 @@
|
||||
#include <DigiCDC.h>
|
||||
void setup() {
|
||||
// initialize the digital pin as an output.
|
||||
SerialUSB.begin();
|
||||
pinMode(1,OUTPUT);
|
||||
}
|
||||
|
||||
// the loop routine runs over and over again forever:
|
||||
void loop() {
|
||||
|
||||
//turns led on and off based on sending 0 or 1 from serial terminal
|
||||
if (SerialUSB.available()) {
|
||||
char input = SerialUSB.read();
|
||||
if(input == '0')
|
||||
digitalWrite(1,LOW);
|
||||
else if(input == '1')
|
||||
digitalWrite(1,HIGH);
|
||||
|
||||
}
|
||||
|
||||
SerialUSB.delay(100); // keep usb alive // can alos use SerialUSB.refresh();
|
||||
}
|
@ -0,0 +1,13 @@
|
||||
|
||||
void setup() {
|
||||
//If prompted for a pairing code it is 1234, 12345, or 000000
|
||||
Serial.begin(9600);
|
||||
}
|
||||
|
||||
// the loop routine runs over and over again forever:
|
||||
void loop() {
|
||||
if (Serial.available()) {
|
||||
Serial.write(Serial.read());
|
||||
}
|
||||
|
||||
}
|
@ -0,0 +1,94 @@
|
||||
void setup() {
|
||||
// put your setup code here, to run once:
|
||||
Serial.begin(9600); //open connection to bt/ble module
|
||||
botInit(); //setup the pins for the bot
|
||||
|
||||
}
|
||||
|
||||
|
||||
void loop() {
|
||||
|
||||
if(Serial.available()){
|
||||
|
||||
char input = Serial.read();
|
||||
|
||||
//route based on input
|
||||
|
||||
if(input == 'f'){
|
||||
botForward(255);
|
||||
}
|
||||
else if(input == 'b'){
|
||||
botReverse(255);
|
||||
}
|
||||
else if(input == 'r'){
|
||||
botRight(255);
|
||||
}
|
||||
else if(input == 'l'){
|
||||
botLeft(255);
|
||||
}
|
||||
else if(input == 's'){
|
||||
botStop();
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
}
|
||||
|
||||
|
||||
void botForward(int botSpeed){
|
||||
digitalWrite(2, HIGH);
|
||||
digitalWrite(5, HIGH);
|
||||
analogWrite(0, 255 - botSpeed);
|
||||
analogWrite(1, 255 - botSpeed);
|
||||
}
|
||||
|
||||
void botReverse(int botSpeed){
|
||||
digitalWrite(2, LOW);
|
||||
digitalWrite(5, LOW);
|
||||
analogWrite(0, botSpeed);
|
||||
analogWrite(1, botSpeed);
|
||||
}
|
||||
|
||||
void botRight(int botSpeed){
|
||||
digitalWrite(2, LOW);
|
||||
digitalWrite(5, HIGH);
|
||||
analogWrite(0, 0);
|
||||
analogWrite(1, 255 - botSpeed);
|
||||
}
|
||||
|
||||
void botHardRight(int botSpeed){
|
||||
digitalWrite(2, LOW);
|
||||
digitalWrite(5, HIGH);
|
||||
analogWrite(0, botSpeed);
|
||||
analogWrite(1, 255 - botSpeed);
|
||||
}
|
||||
|
||||
void botLeft(int botSpeed){
|
||||
digitalWrite(2, HIGH);
|
||||
digitalWrite(5, LOW);
|
||||
analogWrite(0, 255 - botSpeed);
|
||||
analogWrite(1, 0);
|
||||
}
|
||||
|
||||
void botHardLeft(int botSpeed){
|
||||
digitalWrite(2, HIGH);
|
||||
digitalWrite(5, LOW);
|
||||
analogWrite(0, 255 - botSpeed);
|
||||
analogWrite(1, botSpeed);
|
||||
}
|
||||
|
||||
void botStop(){
|
||||
digitalWrite(2,LOW);
|
||||
digitalWrite(5,LOW);
|
||||
analogWrite(0,0);
|
||||
analogWrite(1,0);
|
||||
}
|
||||
|
||||
void botInit(){
|
||||
pinMode(0,OUTPUT);
|
||||
pinMode(1,OUTPUT);
|
||||
pinMode(2,OUTPUT);
|
||||
pinMode(5,OUTPUT);
|
||||
}
|
||||
|
||||
|
@ -67,46 +67,47 @@ void loop() {
|
||||
void sendOK(){
|
||||
sendResponse(F("OK"));
|
||||
}
|
||||
|
||||
void botForward(int botSpeed){
|
||||
digitalWrite(2,HIGH);
|
||||
digitalWrite(5,HIGH);
|
||||
analogWrite(0,botSpeed);
|
||||
analogWrite(1,botSpeed);
|
||||
digitalWrite(2, HIGH);
|
||||
digitalWrite(5, HIGH);
|
||||
analogWrite(0, 255 - botSpeed);
|
||||
analogWrite(1, 255 - botSpeed);
|
||||
}
|
||||
|
||||
void botReverse(int botSpeed){
|
||||
digitalWrite(2,LOW);
|
||||
digitalWrite(5,LOW);
|
||||
analogWrite(0,botSpeed);
|
||||
analogWrite(1,botSpeed);
|
||||
digitalWrite(2, LOW);
|
||||
digitalWrite(5, LOW);
|
||||
analogWrite(0, botSpeed);
|
||||
analogWrite(1, botSpeed);
|
||||
}
|
||||
|
||||
void botRight(int botSpeed){
|
||||
digitalWrite(2,HIGH);
|
||||
digitalWrite(5,LOW);
|
||||
analogWrite(0,botSpeed);
|
||||
analogWrite(1,0);
|
||||
digitalWrite(2, LOW);
|
||||
digitalWrite(5, HIGH);
|
||||
analogWrite(0, 0);
|
||||
analogWrite(1, 255 - botSpeed);
|
||||
}
|
||||
|
||||
void botHardRight(int botSpeed){
|
||||
digitalWrite(2,HIGH);
|
||||
digitalWrite(5,LOW);
|
||||
analogWrite(0,botSpeed);
|
||||
analogWrite(1,botSpeed);
|
||||
digitalWrite(2, LOW);
|
||||
digitalWrite(5, HIGH);
|
||||
analogWrite(0, botSpeed);
|
||||
analogWrite(1, 255 - botSpeed);
|
||||
}
|
||||
|
||||
void botLeft(int botSpeed){
|
||||
digitalWrite(2,LOW);
|
||||
digitalWrite(5,HIGH);
|
||||
analogWrite(0,0);
|
||||
analogWrite(1,botSpeed);
|
||||
digitalWrite(2, HIGH);
|
||||
digitalWrite(5, LOW);
|
||||
analogWrite(0, 255 - botSpeed);
|
||||
analogWrite(1, 0);
|
||||
}
|
||||
|
||||
void botHardLeft(int botSpeed){
|
||||
digitalWrite(2,LOW);
|
||||
digitalWrite(5,HIGH);
|
||||
analogWrite(0,botSpeed);
|
||||
analogWrite(1,botSpeed);
|
||||
digitalWrite(2, HIGH);
|
||||
digitalWrite(5, LOW);
|
||||
analogWrite(0, 255 - botSpeed);
|
||||
analogWrite(1, botSpeed);
|
||||
}
|
||||
|
||||
void botStop(){
|
||||
|
Loading…
x
Reference in New Issue
Block a user