stepper
This commit is contained in:
parent
acc555fa0a
commit
a19a128638
@ -13,3 +13,7 @@ platform = atmelavr
|
|||||||
board = megaatmega2560
|
board = megaatmega2560
|
||||||
//board = uno
|
//board = uno
|
||||||
framework = arduino
|
framework = arduino
|
||||||
|
|
||||||
|
lib_deps =
|
||||||
|
# Using a library name
|
||||||
|
Stepper
|
||||||
|
34
src/main.cpp
34
src/main.cpp
@ -16,7 +16,6 @@
|
|||||||
unsigned int lowSpeed = 6000; // Notabene: nicht über 16000
|
unsigned int lowSpeed = 6000; // Notabene: nicht über 16000
|
||||||
unsigned int highSpeed = 1000;
|
unsigned int highSpeed = 1000;
|
||||||
|
|
||||||
|
|
||||||
// setup for 'LCD Keypad Shield'
|
// setup for 'LCD Keypad Shield'
|
||||||
LiquidCrystal lcd(8,9,4,5,6,7);
|
LiquidCrystal lcd(8,9,4,5,6,7);
|
||||||
|
|
||||||
@ -35,21 +34,21 @@ const int endStop = 33;
|
|||||||
/*-----( Declare Variables )-----*/
|
/*-----( Declare Variables )-----*/
|
||||||
// Big Stepper 1 Revolution = 6400 Steps
|
// Big Stepper 1 Revolution = 6400 Steps
|
||||||
// Small Stepper 1 Revolution = 2048 Steps
|
// Small Stepper 1 Revolution = 2048 Steps
|
||||||
int bigRev = 6400;
|
int bigRev = 6400; // Schritte für eine Umdrehung
|
||||||
int revCounter = 0;
|
int revCounter = 0;
|
||||||
int bigStepCounter = 0;
|
int bigStepCounter = 0;
|
||||||
int lcd_key = 0;
|
int lcd_key = 0;
|
||||||
int lcd_key_prev = 0;
|
int lcd_key_prev = 0;
|
||||||
int adc_key_in = 0;
|
int adc_key_in = 0;
|
||||||
bool startWind = false;
|
bool startWind = false;
|
||||||
int whenJump = 3;
|
int whenJump = 1; // Voreinstellung nach wie viel Umdrehungen gesprungen wird
|
||||||
int wideJump = 10;
|
int wideJump = 4; // Voreinstellung wie weit gesprungen wird
|
||||||
float servoPos = 0;
|
float servoPos = 0;
|
||||||
bool goLeft = true;
|
bool goLeft = true;
|
||||||
int leftSteps = 0;
|
int leftSteps = 0;
|
||||||
|
int farToJump = 1; // set Stepweite auf dem Display
|
||||||
|
|
||||||
void setup()
|
void setup() {
|
||||||
{
|
|
||||||
Serial.begin(115200);
|
Serial.begin(115200);
|
||||||
Serial.print("Program Start");
|
Serial.print("Program Start");
|
||||||
|
|
||||||
@ -78,8 +77,8 @@ void setup()
|
|||||||
lcd.print("Wide:" + String(wideJump));
|
lcd.print("Wide:" + String(wideJump));
|
||||||
}
|
}
|
||||||
|
|
||||||
int read_LCD_buttons(){ // read the buttons
|
int read_LCD_buttons() {
|
||||||
adc_key_in = analogRead(0); // read the value from the sensor
|
adc_key_in = analogRead(0); // read the value from the sensor
|
||||||
|
|
||||||
if (adc_key_in > 1000) return btnNONE;
|
if (adc_key_in > 1000) return btnNONE;
|
||||||
|
|
||||||
@ -89,7 +88,7 @@ int read_LCD_buttons(){ // read the buttons
|
|||||||
if (adc_key_in < 555) return btnLEFT;
|
if (adc_key_in < 555) return btnLEFT;
|
||||||
if (adc_key_in < 790) return btnSELECT;
|
if (adc_key_in < 790) return btnSELECT;
|
||||||
|
|
||||||
return btnNONE; // when all others fail, return this.
|
return btnNONE; // when all others fail, return this.
|
||||||
}
|
}
|
||||||
|
|
||||||
void moveBigStepper(int Steps2Take, int StepsSpeed) {
|
void moveBigStepper(int Steps2Take, int StepsSpeed) {
|
||||||
@ -97,8 +96,8 @@ void moveBigStepper(int Steps2Take, int StepsSpeed) {
|
|||||||
bigStepper.step(Steps2Take);
|
bigStepper.step(Steps2Take);
|
||||||
}
|
}
|
||||||
|
|
||||||
void rechtsrum(unsigned int motorSpeed)
|
void rechtsrum(unsigned int motorSpeed) {
|
||||||
{ // 1
|
// 1
|
||||||
digitalWrite(motorPin4, HIGH);
|
digitalWrite(motorPin4, HIGH);
|
||||||
digitalWrite(motorPin3, LOW);
|
digitalWrite(motorPin3, LOW);
|
||||||
digitalWrite(motorPin2, LOW);
|
digitalWrite(motorPin2, LOW);
|
||||||
@ -155,8 +154,8 @@ void rechtsrum(unsigned int motorSpeed)
|
|||||||
delayMicroseconds(motorSpeed);
|
delayMicroseconds(motorSpeed);
|
||||||
}
|
}
|
||||||
|
|
||||||
void linksrum(unsigned int motorSpeed)
|
void linksrum(unsigned int motorSpeed) {
|
||||||
{ // 1
|
// 1
|
||||||
digitalWrite(motorPin1, HIGH);
|
digitalWrite(motorPin1, HIGH);
|
||||||
digitalWrite(motorPin2, LOW);
|
digitalWrite(motorPin2, LOW);
|
||||||
digitalWrite(motorPin3, LOW);
|
digitalWrite(motorPin3, LOW);
|
||||||
@ -213,8 +212,8 @@ void linksrum(unsigned int motorSpeed)
|
|||||||
delayMicroseconds(motorSpeed);
|
delayMicroseconds(motorSpeed);
|
||||||
}
|
}
|
||||||
|
|
||||||
void stop()
|
void stop() {
|
||||||
{ digitalWrite(motorPin4, LOW);
|
digitalWrite(motorPin4, LOW);
|
||||||
digitalWrite(motorPin3, LOW);
|
digitalWrite(motorPin3, LOW);
|
||||||
digitalWrite(motorPin2, LOW);
|
digitalWrite(motorPin2, LOW);
|
||||||
digitalWrite(motorPin1, LOW);
|
digitalWrite(motorPin1, LOW);
|
||||||
@ -228,13 +227,13 @@ void loop()
|
|||||||
if (lcd_key != lcd_key_prev) {
|
if (lcd_key != lcd_key_prev) {
|
||||||
switch (lcd_key){
|
switch (lcd_key){
|
||||||
case btnRIGHT:{
|
case btnRIGHT:{
|
||||||
wideJump += 10;
|
wideJump += farToJump;
|
||||||
lcd.setCursor(8,1); lcd.print(" ");
|
lcd.setCursor(8,1); lcd.print(" ");
|
||||||
lcd.setCursor(8,1); lcd.print("Wide:" + String(wideJump));
|
lcd.setCursor(8,1); lcd.print("Wide:" + String(wideJump));
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
case btnLEFT:{
|
case btnLEFT:{
|
||||||
if (wideJump > 1) wideJump -= 10;
|
if (wideJump > 1) wideJump -= farToJump;
|
||||||
lcd.setCursor(8,1); lcd.print(" ");
|
lcd.setCursor(8,1); lcd.print(" ");
|
||||||
lcd.setCursor(8,1); lcd.print("Wide:" + String(wideJump));
|
lcd.setCursor(8,1); lcd.print("Wide:" + String(wideJump));
|
||||||
break;
|
break;
|
||||||
@ -262,6 +261,7 @@ void loop()
|
|||||||
}
|
}
|
||||||
else {
|
else {
|
||||||
startWind = false;
|
startWind = false;
|
||||||
|
stop();
|
||||||
lcd.print("Stopping...");
|
lcd.print("Stopping...");
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
|
Loading…
Reference in New Issue
Block a user