ManuelW/Spool-Winder
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

switch to small Stepper

Browse Source
This commit is contained in:
Manuel Weiser 2018-04-29 14:43:00 +02:00
parent 624e390373
commit 2990235dcd
2 changed files with 163 additions and 33 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

37
_versionen/main.cpp
View File

@ -1,9 +1,13 @@
#include <Arduino.h>
#include <Stepper.h>
#include <Servo.h>
#include <LiquidCrystal.h>
// Steps per Revolution for Small Stepper
#define smallStepperStepsRev 32
int servoPin = 11;
Servo servo;
int servoAngle = 0;
// Steps per Revolution for Big Stepper
#define bigStepperStepsRev 200
@ -17,8 +21,7 @@
#define btnNONE 5
// Then the pins are entered here in the sequence 1-3-2-4 for proper sequencing
Stepper smallStepper(smallStepperStepsRev, 30, 31, 32, 33);
Stepper bigStepper(bigStepperStepsRev, 52, 53);
Stepper bigStepper(bigStepperStepsRev, 2, 3);
// setup for 'LCD Keypad Shield'
LiquidCrystal lcd(8,9,4,5,6,7);
@ -26,7 +29,6 @@ LiquidCrystal lcd(8,9,4,5,6,7);
/*-----( Declare Variables )-----*/
// Big Stepper 1 Revolution = 6400 Steps
// Small Stepper 1 Revolution = 2048 Steps
int smallRev = 2048;
int bigRev = 6400;
int revCounter = 0;
int bigStepCounter = 0;
@ -36,11 +38,16 @@ int adc_key_in = 0;
bool startWind = false;
int whenJump = 3;
int wideJump = 10;
float servoPos = 0;
void setup()
{
Serial.begin(115200);
Serial.print("Program Start");
servo.attach(servoPin);
servo.write(servoPos);
// set up the LCD //////////////////////
lcd.begin(2, 16); // Set the size of the LCD
lcd.clear(); // Clear the screen
@ -78,27 +85,21 @@ void moveBigStepper(int Steps2Take, int StepsSpeed) {
bigStepper.step(Steps2Take);
}
void moveSmallStepper(int Steps2Take, int StepsSpeed) {
smallStepper.setSpeed(StepsSpeed);
smallStepper.step(Steps2Take);
}
void loop()
{
//lcd.setCursor(0,1); // move to the begining of the second line
lcd_key_prev = lcd_key;
lcd_key = read_LCD_buttons(); // read the buttons
if (lcd_key != lcd_key_prev) {
switch (lcd_key){
case btnRIGHT:{
wideJump += 1;
wideJump += 10;
lcd.setCursor(8,1); lcd.print(" ");
lcd.setCursor(8,1); lcd.print("Wide:" + String(wideJump));
break;
}
case btnLEFT:{
if (wideJump > 1) wideJump -= 1;
if (wideJump > 1) wideJump -= 10;
lcd.setCursor(8,1); lcd.print(" ");
lcd.setCursor(8,1); lcd.print("Wide:" + String(wideJump));
break;
@ -146,7 +147,15 @@ void loop()
else {
for (int i=0; i<=wideJump; i++) {
moveBigStepper(1, 1000);
moveSmallStepper(1, 500);
if (servoPos >= 170.00) {
servoPos = 0;
}
else {
servoPos +=0.1;
}
servo.write(servoPos);
Serial.println(servoPos);
}
revCounter = 0;
}

159
src/main.cpp
View File

@ -1,14 +1,7 @@
#include <Arduino.h>
#include <Stepper.h>
#include <Servo.h>
#include <LiquidCrystal.h>
int servoPin = 11;
Servo servo;
int servoAngle = 0;
// Steps per Revolution for Big Stepper
#define bigStepperStepsRev 200
@ -20,12 +13,22 @@ int servoAngle = 0;
#define btnSELECT 4
#define btnNONE 5
// Then the pins are entered here in the sequence 1-3-2-4 for proper sequencing
Stepper bigStepper(bigStepperStepsRev, 2, 3);
unsigned int lowSpeed = 10000; // Notabene: nicht über 16000
unsigned int highSpeed = 1000;
// setup for 'LCD Keypad Shield'
LiquidCrystal lcd(8,9,4,5,6,7);
// Then the pins are entered here in the sequence 1-3-2-4 for proper sequencing
Stepper bigStepper(bigStepperStepsRev, 20, 21);
// Setup small Stepper
const int motorPin1 = 51; // Blue - In 1
const int motorPin2 = 52; // Pink - In 2
const int motorPin3 = 53; // Yellow - In 3
const int motorPin4 = 54; // Orange - In 4
/*-----( Declare Variables )-----*/
// Big Stepper 1 Revolution = 6400 Steps
// Small Stepper 1 Revolution = 2048 Steps
@ -45,8 +48,10 @@ void setup()
Serial.begin(115200);
Serial.print("Program Start");
servo.attach(servoPin);
servo.write(servoPos);
pinMode(motorPin1, OUTPUT);
pinMode(motorPin2, OUTPUT);
pinMode(motorPin3, OUTPUT);
pinMode(motorPin4, OUTPUT);
// set up the LCD //////////////////////
lcd.begin(2, 16); // Set the size of the LCD
@ -85,6 +90,129 @@ void moveBigStepper(int Steps2Take, int StepsSpeed) {
bigStepper.step(Steps2Take);
}
void rechtsrum(unsigned int motorSpeed)
{ // 1
digitalWrite(motorPin4, HIGH);
digitalWrite(motorPin3, LOW);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin1, LOW);
delayMicroseconds(motorSpeed);
// 2
digitalWrite(motorPin4, HIGH);
digitalWrite(motorPin3, HIGH);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin1, LOW);
delayMicroseconds(motorSpeed);
// 3
digitalWrite(motorPin4, LOW);
digitalWrite(motorPin3, HIGH);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin1, LOW);
delayMicroseconds(motorSpeed);
// 4
digitalWrite(motorPin4, LOW);
digitalWrite(motorPin3, HIGH);
digitalWrite(motorPin2, HIGH);
digitalWrite(motorPin1, LOW);
delayMicroseconds(motorSpeed);
// 5
digitalWrite(motorPin4, LOW);
digitalWrite(motorPin3, LOW);
digitalWrite(motorPin2, HIGH);
digitalWrite(motorPin1, LOW);
delayMicroseconds(motorSpeed);
// 6
digitalWrite(motorPin4, LOW);
digitalWrite(motorPin3, LOW);
digitalWrite(motorPin2, HIGH);
digitalWrite(motorPin1, HIGH);
delayMicroseconds(motorSpeed);
// 7
digitalWrite(motorPin4, LOW);
digitalWrite(motorPin3, LOW);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin1, HIGH);
delayMicroseconds(motorSpeed);
// 8
digitalWrite(motorPin4, HIGH);
digitalWrite(motorPin3, LOW);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin1, HIGH);
delayMicroseconds(motorSpeed);
}
void linksrum(unsigned int motorSpeed)
{ // 1
digitalWrite(motorPin1, HIGH);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin3, LOW);
digitalWrite(motorPin4, LOW);
delayMicroseconds(motorSpeed);
// 2
digitalWrite(motorPin1, HIGH);
digitalWrite(motorPin2, HIGH);
digitalWrite(motorPin3, LOW);
digitalWrite(motorPin4, LOW);
delayMicroseconds(motorSpeed);
// 3
digitalWrite(motorPin1, LOW);
digitalWrite(motorPin2, HIGH);
digitalWrite(motorPin3, LOW);
digitalWrite(motorPin4, LOW);
delayMicroseconds(motorSpeed);
// 4
digitalWrite(motorPin1, LOW);
digitalWrite(motorPin2, HIGH);
digitalWrite(motorPin3, HIGH);
digitalWrite(motorPin4, LOW);
delayMicroseconds(motorSpeed);
// 5
digitalWrite(motorPin1, LOW);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin3, HIGH);
digitalWrite(motorPin4, LOW);
delayMicroseconds(motorSpeed);
// 6
digitalWrite(motorPin1, LOW);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin3, HIGH);
digitalWrite(motorPin4, HIGH);
delayMicroseconds(motorSpeed);
// 7
digitalWrite(motorPin1, LOW);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin3, LOW);
digitalWrite(motorPin4, HIGH);
delayMicroseconds(motorSpeed);
// 8
digitalWrite(motorPin1, HIGH);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin3, LOW);
digitalWrite(motorPin4, HIGH);
delayMicroseconds(motorSpeed);
}
void stop()
{ digitalWrite(motorPin4, LOW);
digitalWrite(motorPin3, LOW);
digitalWrite(motorPin2, LOW);
digitalWrite(motorPin1, LOW);
}
void loop()
{
lcd_key_prev = lcd_key;
@ -148,14 +276,7 @@ void loop()
for (int i=0; i<=wideJump; i++) {
moveBigStepper(1, 1000);
if (servoPos >= 170.00) {
servoPos = 0;
}
else {
servoPos +=0.1;
}
servo.write(servoPos);
Serial.println(servoPos);
rechtsrum(lowSpeed);
}
revCounter = 0;
}