initial Version Stepper with Servo
This commit is contained in:
Manuel Weiser
commit
b6434324cd
4
.gitignore
vendored
Normal file
4
.gitignore
vendored
Normal file
@ -0,0 +1,4 @@
|
||||
.pioenvs
|
||||
.piolibdeps
|
||||
.clang_complete
|
||||
.gcc-flags.json
|
||||
67
.travis.yml
Normal file
67
.travis.yml
Normal file
@ -0,0 +1,67 @@
|
||||
# Continuous Integration (CI) is the practice, in software
|
||||
# engineering, of merging all developer working copies with a shared mainline
|
||||
# several times a day < http://docs.platformio.org/page/ci/index.html >
|
||||
#
|
||||
# Documentation:
|
||||
#
|
||||
# * Travis CI Embedded Builds with PlatformIO
|
||||
# < https://docs.travis-ci.com/user/integration/platformio/ >
|
||||
#
|
||||
# * PlatformIO integration with Travis CI
|
||||
# < http://docs.platformio.org/page/ci/travis.html >
|
||||
#
|
||||
# * User Guide for `platformio ci` command
|
||||
# < http://docs.platformio.org/page/userguide/cmd_ci.html >
|
||||
#
|
||||
#
|
||||
# Please choice one of the following templates (proposed below) and uncomment
|
||||
# it (remove "# " before each line) or use own configuration according to the
|
||||
# Travis CI documentation (see above).
|
||||
#
|
||||
|
||||
|
||||
#
|
||||
# Template #1: General project. Test it using existing `platformio.ini`.
|
||||
#
|
||||
|
||||
# language: python
|
||||
# python:
|
||||
# - "2.7"
|
||||
#
|
||||
# sudo: false
|
||||
# cache:
|
||||
# directories:
|
||||
# - "~/.platformio"
|
||||
#
|
||||
# install:
|
||||
# - pip install -U platformio
|
||||
# - platformio update
|
||||
#
|
||||
# script:
|
||||
# - platformio run
|
||||
|
||||
|
||||
#
|
||||
# Template #2: The project is intended to by used as a library with examples
|
||||
#
|
||||
|
||||
# language: python
|
||||
# python:
|
||||
# - "2.7"
|
||||
#
|
||||
# sudo: false
|
||||
# cache:
|
||||
# directories:
|
||||
# - "~/.platformio"
|
||||
#
|
||||
# env:
|
||||
# - PLATFORMIO_CI_SRC=path/to/test/file.c
|
||||
# - PLATFORMIO_CI_SRC=examples/file.ino
|
||||
# - PLATFORMIO_CI_SRC=path/to/test/directory
|
||||
#
|
||||
# install:
|
||||
# - pip install -U platformio
|
||||
# - platformio update
|
||||
#
|
||||
# script:
|
||||
# - platformio ci --lib="." --board=ID_1 --board=ID_2 --board=ID_N
|
||||
154
_versionen/main.cpp
Normal file
154
_versionen/main.cpp
Normal file
@ -0,0 +1,154 @@
|
||||
#include <Arduino.h>
|
||||
#include <Stepper.h>
|
||||
#include <LiquidCrystal.h>
|
||||
|
||||
// Steps per Revolution for Small Stepper
|
||||
#define smallStepperStepsRev 32
|
||||
|
||||
// Steps per Revolution for Big Stepper
|
||||
#define bigStepperStepsRev 200
|
||||
|
||||
// LCD Buttons
|
||||
#define btnRIGHT 0
|
||||
#define btnUP 1
|
||||
#define btnDOWN 2
|
||||
#define btnLEFT 3
|
||||
#define btnSELECT 4
|
||||
#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);
|
||||
|
||||
// setup for 'LCD Keypad Shield'
|
||||
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;
|
||||
int lcd_key = 0;
|
||||
int lcd_key_prev = 0;
|
||||
int adc_key_in = 0;
|
||||
bool startWind = false;
|
||||
int whenJump = 3;
|
||||
int wideJump = 10;
|
||||
|
||||
void setup()
|
||||
{
|
||||
Serial.begin(115200);
|
||||
Serial.print("Program Start");
|
||||
// set up the LCD //////////////////////
|
||||
lcd.begin(2, 16); // Set the size of the LCD
|
||||
lcd.clear(); // Clear the screen
|
||||
lcd.setCursor(0,0); // Set cursor for next line
|
||||
lcd.print("Spool Winder"); // Print this line
|
||||
lcd.setCursor(0,1); // Set cursor for next line
|
||||
lcd.print("by ManuelW"); // Print this line
|
||||
delay(3000); // Wait 3 seconds
|
||||
|
||||
lcd.clear();
|
||||
lcd.setCursor(0,0);
|
||||
lcd.print("Waiting...");
|
||||
lcd.setCursor(0,1);
|
||||
lcd.print("Turn:" + String(whenJump));
|
||||
lcd.setCursor(8,1);
|
||||
lcd.print("Wide:" + String(wideJump));
|
||||
}
|
||||
|
||||
int read_LCD_buttons(){ // read the buttons
|
||||
adc_key_in = analogRead(0); // read the value from the sensor
|
||||
|
||||
if (adc_key_in > 1000) return btnNONE;
|
||||
|
||||
if (adc_key_in < 50) return btnRIGHT;
|
||||
if (adc_key_in < 195) return btnUP;
|
||||
if (adc_key_in < 380) return btnDOWN;
|
||||
if (adc_key_in < 555) return btnLEFT;
|
||||
if (adc_key_in < 790) return btnSELECT;
|
||||
|
||||
return btnNONE; // when all others fail, return this.
|
||||
}
|
||||
|
||||
void moveBigStepper(int Steps2Take, int StepsSpeed) {
|
||||
bigStepper.setSpeed(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;
|
||||
lcd.setCursor(8,1); lcd.print(" ");
|
||||
lcd.setCursor(8,1); lcd.print("Wide:" + String(wideJump));
|
||||
break;
|
||||
}
|
||||
case btnLEFT:{
|
||||
if (wideJump > 1) wideJump -= 1;
|
||||
lcd.setCursor(8,1); lcd.print(" ");
|
||||
lcd.setCursor(8,1); lcd.print("Wide:" + String(wideJump));
|
||||
break;
|
||||
}
|
||||
case btnUP:{
|
||||
whenJump += 1;
|
||||
lcd.setCursor(0,1); lcd.print(" ");
|
||||
lcd.setCursor(0,1); lcd.print("Turn:" + String(whenJump));
|
||||
break;
|
||||
}
|
||||
case btnDOWN:{
|
||||
if (whenJump > 1) whenJump -= 1;
|
||||
lcd.setCursor(0,1); lcd.print(" ");
|
||||
lcd.setCursor(0,1); lcd.print("Turn:" + String(whenJump));
|
||||
break;
|
||||
}
|
||||
case btnSELECT:{
|
||||
//lcd.print("SELECT"); // push button "SELECT" and show the word on the screen
|
||||
lcd.setCursor(0,0);
|
||||
lcd.print(" ");
|
||||
lcd.setCursor(0,0);
|
||||
if (startWind == false) {
|
||||
startWind = true;
|
||||
lcd.print("Running...");
|
||||
}
|
||||
else {
|
||||
startWind = false;
|
||||
lcd.print("Stopping...");
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (startWind == true) {
|
||||
if (revCounter < whenJump) {
|
||||
moveBigStepper(1, 1000);
|
||||
|
||||
bigStepCounter++;
|
||||
if (bigStepCounter == bigRev) {
|
||||
revCounter++;
|
||||
bigStepCounter = 0;
|
||||
}
|
||||
}
|
||||
else {
|
||||
for (int i=0; i<=wideJump; i++) {
|
||||
moveBigStepper(1, 1000);
|
||||
moveSmallStepper(1, 500);
|
||||
}
|
||||
revCounter = 0;
|
||||
}
|
||||
}
|
||||
}
|
||||
41
lib/readme.txt
Normal file
41
lib/readme.txt
Normal file
@ -0,0 +1,41 @@
|
||||
|
||||
This directory is intended for the project specific (private) libraries.
|
||||
PlatformIO will compile them to static libraries and link to executable file.
|
||||
|
||||
The source code of each library should be placed in separate directory, like
|
||||
"lib/private_lib/[here are source files]".
|
||||
|
||||
For example, see how can be organized `Foo` and `Bar` libraries:
|
||||
|
||||
|--lib
|
||||
| |
|
||||
| |--Bar
|
||||
| | |--docs
|
||||
| | |--examples
|
||||
| | |--src
|
||||
| | |- Bar.c
|
||||
| | |- Bar.h
|
||||
| | |- library.json (optional, custom build options, etc) http://docs.platformio.org/page/librarymanager/config.html
|
||||
| |
|
||||
| |--Foo
|
||||
| | |- Foo.c
|
||||
| | |- Foo.h
|
||||
| |
|
||||
| |- readme.txt --> THIS FILE
|
||||
|
|
||||
|- platformio.ini
|
||||
|--src
|
||||
|- main.c
|
||||
|
||||
Then in `src/main.c` you should use:
|
||||
|
||||
#include <Foo.h>
|
||||
#include <Bar.h>
|
||||
|
||||
// rest H/C/CPP code
|
||||
|
||||
PlatformIO will find your libraries automatically, configure preprocessor's
|
||||
include paths and build them.
|
||||
|
||||
More information about PlatformIO Library Dependency Finder
|
||||
- http://docs.platformio.org/page/librarymanager/ldf.html
|
||||
15
platformio.ini
Normal file
15
platformio.ini
Normal file
@ -0,0 +1,15 @@
|
||||
; PlatformIO Project Configuration File
|
||||
;
|
||||
; Build options: build flags, source filter
|
||||
; Upload options: custom upload port, speed and extra flags
|
||||
; Library options: dependencies, extra library storages
|
||||
; Advanced options: extra scripting
|
||||
;
|
||||
; Please visit documentation for the other options and examples
|
||||
; http://docs.platformio.org/page/projectconf.html
|
||||
|
||||
[env:arduino]
|
||||
platform = atmelavr
|
||||
board = megaatmega2560
|
||||
//board = uno
|
||||
framework = arduino
|
||||
173
src/main.cpp
Normal file
173
src/main.cpp
Normal file
@ -0,0 +1,173 @@
|
||||
#include <Arduino.h>
|
||||
#include <Stepper.h>
|
||||
#include <Servo.h>
|
||||
#include <LiquidCrystal.h>
|
||||
|
||||
int servoPin = 50;
|
||||
|
||||
Servo servo;
|
||||
|
||||
int servoAngle = 0;
|
||||
|
||||
// Steps per Revolution for Small Stepper
|
||||
#define smallStepperStepsRev 32
|
||||
|
||||
// Steps per Revolution for Big Stepper
|
||||
#define bigStepperStepsRev 200
|
||||
|
||||
// LCD Buttons
|
||||
#define btnRIGHT 0
|
||||
#define btnUP 1
|
||||
#define btnDOWN 2
|
||||
#define btnLEFT 3
|
||||
#define btnSELECT 4
|
||||
#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);
|
||||
|
||||
// setup for 'LCD Keypad Shield'
|
||||
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;
|
||||
int lcd_key = 0;
|
||||
int lcd_key_prev = 0;
|
||||
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
|
||||
lcd.setCursor(0,0); // Set cursor for next line
|
||||
lcd.print("Spool Winder"); // Print this line
|
||||
lcd.setCursor(0,1); // Set cursor for next line
|
||||
lcd.print("by ManuelW"); // Print this line
|
||||
delay(3000); // Wait 3 seconds
|
||||
|
||||
lcd.clear();
|
||||
lcd.setCursor(0,0);
|
||||
lcd.print("Waiting...");
|
||||
lcd.setCursor(0,1);
|
||||
lcd.print("Turn:" + String(whenJump));
|
||||
lcd.setCursor(8,1);
|
||||
lcd.print("Wide:" + String(wideJump));
|
||||
}
|
||||
|
||||
int read_LCD_buttons(){ // read the buttons
|
||||
adc_key_in = analogRead(0); // read the value from the sensor
|
||||
|
||||
if (adc_key_in > 1000) return btnNONE;
|
||||
|
||||
if (adc_key_in < 50) return btnRIGHT;
|
||||
if (adc_key_in < 195) return btnUP;
|
||||
if (adc_key_in < 380) return btnDOWN;
|
||||
if (adc_key_in < 555) return btnLEFT;
|
||||
if (adc_key_in < 790) return btnSELECT;
|
||||
|
||||
return btnNONE; // when all others fail, return this.
|
||||
}
|
||||
|
||||
void moveBigStepper(int Steps2Take, int StepsSpeed) {
|
||||
bigStepper.setSpeed(StepsSpeed);
|
||||
bigStepper.step(Steps2Take);
|
||||
}
|
||||
|
||||
void moveSmallStepper(int Steps2Take, int StepsSpeed) {
|
||||
smallStepper.setSpeed(StepsSpeed);
|
||||
smallStepper.step(Steps2Take);
|
||||
}
|
||||
|
||||
void loop()
|
||||
{
|
||||
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 += 10;
|
||||
lcd.setCursor(8,1); lcd.print(" ");
|
||||
lcd.setCursor(8,1); lcd.print("Wide:" + String(wideJump));
|
||||
break;
|
||||
}
|
||||
case btnLEFT:{
|
||||
if (wideJump > 1) wideJump -= 10;
|
||||
lcd.setCursor(8,1); lcd.print(" ");
|
||||
lcd.setCursor(8,1); lcd.print("Wide:" + String(wideJump));
|
||||
break;
|
||||
}
|
||||
case btnUP:{
|
||||
whenJump += 1;
|
||||
lcd.setCursor(0,1); lcd.print(" ");
|
||||
lcd.setCursor(0,1); lcd.print("Turn:" + String(whenJump));
|
||||
break;
|
||||
}
|
||||
case btnDOWN:{
|
||||
if (whenJump > 1) whenJump -= 1;
|
||||
lcd.setCursor(0,1); lcd.print(" ");
|
||||
lcd.setCursor(0,1); lcd.print("Turn:" + String(whenJump));
|
||||
break;
|
||||
}
|
||||
case btnSELECT:{
|
||||
//lcd.print("SELECT"); // push button "SELECT" and show the word on the screen
|
||||
lcd.setCursor(0,0);
|
||||
lcd.print(" ");
|
||||
lcd.setCursor(0,0);
|
||||
if (startWind == false) {
|
||||
startWind = true;
|
||||
lcd.print("Running...");
|
||||
}
|
||||
else {
|
||||
startWind = false;
|
||||
lcd.print("Stopping...");
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (startWind == true) {
|
||||
if (revCounter < whenJump) {
|
||||
moveBigStepper(1, 1000);
|
||||
|
||||
bigStepCounter++;
|
||||
if (bigStepCounter == bigRev) {
|
||||
revCounter++;
|
||||
bigStepCounter = 0;
|
||||
}
|
||||
}
|
||||
else {
|
||||
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);
|
||||
}
|
||||
revCounter = 0;
|
||||
}
|
||||
}
|
||||
}
|
||||
Loading…
Reference in New Issue
Block a user