added arduino, modified build
This commit is contained in:
26
arduino/libraries/Stepper/README.adoc
Normal file
26
arduino/libraries/Stepper/README.adoc
Normal file
@@ -0,0 +1,26 @@
|
||||
= Stepper Library for Arduino =
|
||||
|
||||
This library allows you to control unipolar or bipolar stepper motors. To use it you will need a stepper motor, and the appropriate hardware to control it.
|
||||
|
||||
For more information about this library please visit us at
|
||||
http://www.arduino.cc/en/Reference/Stepper
|
||||
|
||||
== License ==
|
||||
|
||||
Copyright (c) Arduino LLC. All right reserved.
|
||||
Copyright (c) Sebastian Gassner. All right reserved.
|
||||
Copyright (c) Noah Shibley. All right reserved.
|
||||
|
||||
This library is free software; you can redistribute it and/or
|
||||
modify it under the terms of the GNU Lesser General Public
|
||||
License as published by the Free Software Foundation; either
|
||||
version 2.1 of the License, or (at your option) any later version.
|
||||
|
||||
This library is distributed in the hope that it will be useful,
|
||||
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||||
Lesser General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU Lesser General Public
|
||||
License along with this library; if not, write to the Free Software
|
||||
Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||||
39
arduino/libraries/Stepper/examples/MotorKnob/MotorKnob.ino
Normal file
39
arduino/libraries/Stepper/examples/MotorKnob/MotorKnob.ino
Normal file
@@ -0,0 +1,39 @@
|
||||
/*
|
||||
* MotorKnob
|
||||
*
|
||||
* A stepper motor follows the turns of a potentiometer
|
||||
* (or other sensor) on analog input 0.
|
||||
*
|
||||
* http://www.arduino.cc/en/Reference/Stepper
|
||||
* This example code is in the public domain.
|
||||
*/
|
||||
|
||||
#include <Stepper.h>
|
||||
|
||||
// change this to the number of steps on your motor
|
||||
#define STEPS 100
|
||||
|
||||
// create an instance of the stepper class, specifying
|
||||
// the number of steps of the motor and the pins it's
|
||||
// attached to
|
||||
Stepper stepper(STEPS, 8, 9, 10, 11);
|
||||
|
||||
// the previous reading from the analog input
|
||||
int previous = 0;
|
||||
|
||||
void setup() {
|
||||
// set the speed of the motor to 30 RPMs
|
||||
stepper.setSpeed(30);
|
||||
}
|
||||
|
||||
void loop() {
|
||||
// get the sensor value
|
||||
int val = analogRead(0);
|
||||
|
||||
// move a number of steps equal to the change in the
|
||||
// sensor reading
|
||||
stepper.step(val - previous);
|
||||
|
||||
// remember the previous value of the sensor
|
||||
previous = val;
|
||||
}
|
||||
@@ -0,0 +1,44 @@
|
||||
|
||||
/*
|
||||
Stepper Motor Control - one revolution
|
||||
|
||||
This program drives a unipolar or bipolar stepper motor.
|
||||
The motor is attached to digital pins 8 - 11 of the Arduino.
|
||||
|
||||
The motor should revolve one revolution in one direction, then
|
||||
one revolution in the other direction.
|
||||
|
||||
|
||||
Created 11 Mar. 2007
|
||||
Modified 30 Nov. 2009
|
||||
by Tom Igoe
|
||||
|
||||
*/
|
||||
|
||||
#include <Stepper.h>
|
||||
|
||||
const int stepsPerRevolution = 200; // change this to fit the number of steps per revolution
|
||||
// for your motor
|
||||
|
||||
// initialize the stepper library on pins 8 through 11:
|
||||
Stepper myStepper(stepsPerRevolution, 8, 9, 10, 11);
|
||||
|
||||
void setup() {
|
||||
// set the speed at 60 rpm:
|
||||
myStepper.setSpeed(60);
|
||||
// initialize the serial port:
|
||||
Serial.begin(9600);
|
||||
}
|
||||
|
||||
void loop() {
|
||||
// step one revolution in one direction:
|
||||
Serial.println("clockwise");
|
||||
myStepper.step(stepsPerRevolution);
|
||||
delay(500);
|
||||
|
||||
// step one revolution in the other direction:
|
||||
Serial.println("counterclockwise");
|
||||
myStepper.step(-stepsPerRevolution);
|
||||
delay(500);
|
||||
}
|
||||
|
||||
@@ -0,0 +1,44 @@
|
||||
|
||||
/*
|
||||
Stepper Motor Control - one step at a time
|
||||
|
||||
This program drives a unipolar or bipolar stepper motor.
|
||||
The motor is attached to digital pins 8 - 11 of the Arduino.
|
||||
|
||||
The motor will step one step at a time, very slowly. You can use this to
|
||||
test that you've got the four wires of your stepper wired to the correct
|
||||
pins. If wired correctly, all steps should be in the same direction.
|
||||
|
||||
Use this also to count the number of steps per revolution of your motor,
|
||||
if you don't know it. Then plug that number into the oneRevolution
|
||||
example to see if you got it right.
|
||||
|
||||
Created 30 Nov. 2009
|
||||
by Tom Igoe
|
||||
|
||||
*/
|
||||
|
||||
#include <Stepper.h>
|
||||
|
||||
const int stepsPerRevolution = 200; // change this to fit the number of steps per revolution
|
||||
// for your motor
|
||||
|
||||
// initialize the stepper library on pins 8 through 11:
|
||||
Stepper myStepper(stepsPerRevolution, 8, 9, 10, 11);
|
||||
|
||||
int stepCount = 0; // number of steps the motor has taken
|
||||
|
||||
void setup() {
|
||||
// initialize the serial port:
|
||||
Serial.begin(9600);
|
||||
}
|
||||
|
||||
void loop() {
|
||||
// step one step:
|
||||
myStepper.step(1);
|
||||
Serial.print("steps:");
|
||||
Serial.println(stepCount);
|
||||
stepCount++;
|
||||
delay(500);
|
||||
}
|
||||
|
||||
@@ -0,0 +1,48 @@
|
||||
|
||||
/*
|
||||
Stepper Motor Control - speed control
|
||||
|
||||
This program drives a unipolar or bipolar stepper motor.
|
||||
The motor is attached to digital pins 8 - 11 of the Arduino.
|
||||
A potentiometer is connected to analog input 0.
|
||||
|
||||
The motor will rotate in a clockwise direction. The higher the potentiometer value,
|
||||
the faster the motor speed. Because setSpeed() sets the delay between steps,
|
||||
you may notice the motor is less responsive to changes in the sensor value at
|
||||
low speeds.
|
||||
|
||||
Created 30 Nov. 2009
|
||||
Modified 28 Oct 2010
|
||||
by Tom Igoe
|
||||
|
||||
*/
|
||||
|
||||
#include <Stepper.h>
|
||||
|
||||
const int stepsPerRevolution = 200; // change this to fit the number of steps per revolution
|
||||
// for your motor
|
||||
|
||||
|
||||
// initialize the stepper library on pins 8 through 11:
|
||||
Stepper myStepper(stepsPerRevolution, 8, 9, 10, 11);
|
||||
|
||||
int stepCount = 0; // number of steps the motor has taken
|
||||
|
||||
void setup() {
|
||||
// nothing to do inside the setup
|
||||
}
|
||||
|
||||
void loop() {
|
||||
// read the sensor value:
|
||||
int sensorReading = analogRead(A0);
|
||||
// map it to a range from 0 to 100:
|
||||
int motorSpeed = map(sensorReading, 0, 1023, 0, 100);
|
||||
// set the motor speed:
|
||||
if (motorSpeed > 0) {
|
||||
myStepper.setSpeed(motorSpeed);
|
||||
// step 1/100 of a revolution:
|
||||
myStepper.step(stepsPerRevolution / 100);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
28
arduino/libraries/Stepper/keywords.txt
Normal file
28
arduino/libraries/Stepper/keywords.txt
Normal file
@@ -0,0 +1,28 @@
|
||||
#######################################
|
||||
# Syntax Coloring Map For Test
|
||||
#######################################
|
||||
|
||||
#######################################
|
||||
# Datatypes (KEYWORD1)
|
||||
#######################################
|
||||
|
||||
Stepper KEYWORD1 Stepper
|
||||
|
||||
#######################################
|
||||
# Methods and Functions (KEYWORD2)
|
||||
#######################################
|
||||
|
||||
step KEYWORD2
|
||||
setSpeed KEYWORD2
|
||||
version KEYWORD2
|
||||
|
||||
######################################
|
||||
# Instances (KEYWORD2)
|
||||
#######################################
|
||||
direction KEYWORD2
|
||||
speed KEYWORD2
|
||||
|
||||
|
||||
#######################################
|
||||
# Constants (LITERAL1)
|
||||
#######################################
|
||||
9
arduino/libraries/Stepper/library.properties
Normal file
9
arduino/libraries/Stepper/library.properties
Normal file
@@ -0,0 +1,9 @@
|
||||
name=Stepper
|
||||
version=1.1.3
|
||||
author=Arduino
|
||||
maintainer=Arduino <info@arduino.cc>
|
||||
sentence=Allows Arduino boards to control a variety of stepper motors.
|
||||
paragraph=This library allows you to control unipolar or bipolar stepper motors. To use it you will need a stepper motor, and the appropriate hardware to control it.
|
||||
category=Device Control
|
||||
url=http://www.arduino.cc/en/Reference/Stepper
|
||||
architectures=*
|
||||
365
arduino/libraries/Stepper/src/Stepper.cpp
Normal file
365
arduino/libraries/Stepper/src/Stepper.cpp
Normal file
@@ -0,0 +1,365 @@
|
||||
/*
|
||||
* Stepper.cpp - Stepper library for Wiring/Arduino - Version 1.1.0
|
||||
*
|
||||
* Original library (0.1) by Tom Igoe.
|
||||
* Two-wire modifications (0.2) by Sebastian Gassner
|
||||
* Combination version (0.3) by Tom Igoe and David Mellis
|
||||
* Bug fix for four-wire (0.4) by Tom Igoe, bug fix from Noah Shibley
|
||||
* High-speed stepping mod by Eugene Kozlenko
|
||||
* Timer rollover fix by Eugene Kozlenko
|
||||
* Five phase five wire (1.1.0) by Ryan Orendorff
|
||||
*
|
||||
* This library is free software; you can redistribute it and/or
|
||||
* modify it under the terms of the GNU Lesser General Public
|
||||
* License as published by the Free Software Foundation; either
|
||||
* version 2.1 of the License, or (at your option) any later version.
|
||||
*
|
||||
* This library is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||||
* Lesser General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU Lesser General Public
|
||||
* License along with this library; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||||
*
|
||||
*
|
||||
* Drives a unipolar, bipolar, or five phase stepper motor.
|
||||
*
|
||||
* When wiring multiple stepper motors to a microcontroller, you quickly run
|
||||
* out of output pins, with each motor requiring 4 connections.
|
||||
*
|
||||
* By making use of the fact that at any time two of the four motor coils are
|
||||
* the inverse of the other two, the number of control connections can be
|
||||
* reduced from 4 to 2 for the unipolar and bipolar motors.
|
||||
*
|
||||
* A slightly modified circuit around a Darlington transistor array or an
|
||||
* L293 H-bridge connects to only 2 microcontroler pins, inverts the signals
|
||||
* received, and delivers the 4 (2 plus 2 inverted ones) output signals
|
||||
* required for driving a stepper motor. Similarly the Arduino motor shields
|
||||
* 2 direction pins may be used.
|
||||
*
|
||||
* The sequence of control signals for 5 phase, 5 control wires is as follows:
|
||||
*
|
||||
* Step C0 C1 C2 C3 C4
|
||||
* 1 0 1 1 0 1
|
||||
* 2 0 1 0 0 1
|
||||
* 3 0 1 0 1 1
|
||||
* 4 0 1 0 1 0
|
||||
* 5 1 1 0 1 0
|
||||
* 6 1 0 0 1 0
|
||||
* 7 1 0 1 1 0
|
||||
* 8 1 0 1 0 0
|
||||
* 9 1 0 1 0 1
|
||||
* 10 0 0 1 0 1
|
||||
*
|
||||
* The sequence of control signals for 4 control wires is as follows:
|
||||
*
|
||||
* Step C0 C1 C2 C3
|
||||
* 1 1 0 1 0
|
||||
* 2 0 1 1 0
|
||||
* 3 0 1 0 1
|
||||
* 4 1 0 0 1
|
||||
*
|
||||
* The sequence of controls signals for 2 control wires is as follows
|
||||
* (columns C1 and C2 from above):
|
||||
*
|
||||
* Step C0 C1
|
||||
* 1 0 1
|
||||
* 2 1 1
|
||||
* 3 1 0
|
||||
* 4 0 0
|
||||
*
|
||||
* The circuits can be found at
|
||||
*
|
||||
* http://www.arduino.cc/en/Tutorial/Stepper
|
||||
*/
|
||||
|
||||
#include "Arduino.h"
|
||||
#include "Stepper.h"
|
||||
|
||||
/*
|
||||
* two-wire constructor.
|
||||
* Sets which wires should control the motor.
|
||||
*/
|
||||
Stepper::Stepper(int number_of_steps, int motor_pin_1, int motor_pin_2)
|
||||
{
|
||||
this->step_number = 0; // which step the motor is on
|
||||
this->direction = 0; // motor direction
|
||||
this->last_step_time = 0; // time stamp in us of the last step taken
|
||||
this->number_of_steps = number_of_steps; // total number of steps for this motor
|
||||
|
||||
// Arduino pins for the motor control connection:
|
||||
this->motor_pin_1 = motor_pin_1;
|
||||
this->motor_pin_2 = motor_pin_2;
|
||||
|
||||
// setup the pins on the microcontroller:
|
||||
pinMode(this->motor_pin_1, OUTPUT);
|
||||
pinMode(this->motor_pin_2, OUTPUT);
|
||||
|
||||
// When there are only 2 pins, set the others to 0:
|
||||
this->motor_pin_3 = 0;
|
||||
this->motor_pin_4 = 0;
|
||||
this->motor_pin_5 = 0;
|
||||
|
||||
// pin_count is used by the stepMotor() method:
|
||||
this->pin_count = 2;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* constructor for four-pin version
|
||||
* Sets which wires should control the motor.
|
||||
*/
|
||||
Stepper::Stepper(int number_of_steps, int motor_pin_1, int motor_pin_2,
|
||||
int motor_pin_3, int motor_pin_4)
|
||||
{
|
||||
this->step_number = 0; // which step the motor is on
|
||||
this->direction = 0; // motor direction
|
||||
this->last_step_time = 0; // time stamp in us of the last step taken
|
||||
this->number_of_steps = number_of_steps; // total number of steps for this motor
|
||||
|
||||
// Arduino pins for the motor control connection:
|
||||
this->motor_pin_1 = motor_pin_1;
|
||||
this->motor_pin_2 = motor_pin_2;
|
||||
this->motor_pin_3 = motor_pin_3;
|
||||
this->motor_pin_4 = motor_pin_4;
|
||||
|
||||
// setup the pins on the microcontroller:
|
||||
pinMode(this->motor_pin_1, OUTPUT);
|
||||
pinMode(this->motor_pin_2, OUTPUT);
|
||||
pinMode(this->motor_pin_3, OUTPUT);
|
||||
pinMode(this->motor_pin_4, OUTPUT);
|
||||
|
||||
// When there are 4 pins, set the others to 0:
|
||||
this->motor_pin_5 = 0;
|
||||
|
||||
// pin_count is used by the stepMotor() method:
|
||||
this->pin_count = 4;
|
||||
}
|
||||
|
||||
/*
|
||||
* constructor for five phase motor with five wires
|
||||
* Sets which wires should control the motor.
|
||||
*/
|
||||
Stepper::Stepper(int number_of_steps, int motor_pin_1, int motor_pin_2,
|
||||
int motor_pin_3, int motor_pin_4,
|
||||
int motor_pin_5)
|
||||
{
|
||||
this->step_number = 0; // which step the motor is on
|
||||
this->direction = 0; // motor direction
|
||||
this->last_step_time = 0; // time stamp in us of the last step taken
|
||||
this->number_of_steps = number_of_steps; // total number of steps for this motor
|
||||
|
||||
// Arduino pins for the motor control connection:
|
||||
this->motor_pin_1 = motor_pin_1;
|
||||
this->motor_pin_2 = motor_pin_2;
|
||||
this->motor_pin_3 = motor_pin_3;
|
||||
this->motor_pin_4 = motor_pin_4;
|
||||
this->motor_pin_5 = motor_pin_5;
|
||||
|
||||
// setup the pins on the microcontroller:
|
||||
pinMode(this->motor_pin_1, OUTPUT);
|
||||
pinMode(this->motor_pin_2, OUTPUT);
|
||||
pinMode(this->motor_pin_3, OUTPUT);
|
||||
pinMode(this->motor_pin_4, OUTPUT);
|
||||
pinMode(this->motor_pin_5, OUTPUT);
|
||||
|
||||
// pin_count is used by the stepMotor() method:
|
||||
this->pin_count = 5;
|
||||
}
|
||||
|
||||
/*
|
||||
* Sets the speed in revs per minute
|
||||
*/
|
||||
void Stepper::setSpeed(long whatSpeed)
|
||||
{
|
||||
this->step_delay = 60L * 1000L * 1000L / this->number_of_steps / whatSpeed;
|
||||
}
|
||||
|
||||
/*
|
||||
* Moves the motor steps_to_move steps. If the number is negative,
|
||||
* the motor moves in the reverse direction.
|
||||
*/
|
||||
void Stepper::step(int steps_to_move)
|
||||
{
|
||||
int steps_left = abs(steps_to_move); // how many steps to take
|
||||
|
||||
// determine direction based on whether steps_to_mode is + or -:
|
||||
if (steps_to_move > 0) { this->direction = 1; }
|
||||
if (steps_to_move < 0) { this->direction = 0; }
|
||||
|
||||
|
||||
// decrement the number of steps, moving one step each time:
|
||||
while (steps_left > 0)
|
||||
{
|
||||
unsigned long now = micros();
|
||||
// move only if the appropriate delay has passed:
|
||||
if (now - this->last_step_time >= this->step_delay)
|
||||
{
|
||||
// get the timeStamp of when you stepped:
|
||||
this->last_step_time = now;
|
||||
// increment or decrement the step number,
|
||||
// depending on direction:
|
||||
if (this->direction == 1)
|
||||
{
|
||||
this->step_number++;
|
||||
if (this->step_number == this->number_of_steps) {
|
||||
this->step_number = 0;
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
if (this->step_number == 0) {
|
||||
this->step_number = this->number_of_steps;
|
||||
}
|
||||
this->step_number--;
|
||||
}
|
||||
// decrement the steps left:
|
||||
steps_left--;
|
||||
// step the motor to step number 0, 1, ..., {3 or 10}
|
||||
if (this->pin_count == 5)
|
||||
stepMotor(this->step_number % 10);
|
||||
else
|
||||
stepMotor(this->step_number % 4);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* Moves the motor forward or backwards.
|
||||
*/
|
||||
void Stepper::stepMotor(int thisStep)
|
||||
{
|
||||
if (this->pin_count == 2) {
|
||||
switch (thisStep) {
|
||||
case 0: // 01
|
||||
digitalWrite(motor_pin_1, LOW);
|
||||
digitalWrite(motor_pin_2, HIGH);
|
||||
break;
|
||||
case 1: // 11
|
||||
digitalWrite(motor_pin_1, HIGH);
|
||||
digitalWrite(motor_pin_2, HIGH);
|
||||
break;
|
||||
case 2: // 10
|
||||
digitalWrite(motor_pin_1, HIGH);
|
||||
digitalWrite(motor_pin_2, LOW);
|
||||
break;
|
||||
case 3: // 00
|
||||
digitalWrite(motor_pin_1, LOW);
|
||||
digitalWrite(motor_pin_2, LOW);
|
||||
break;
|
||||
}
|
||||
}
|
||||
if (this->pin_count == 4) {
|
||||
switch (thisStep) {
|
||||
case 0: // 1010
|
||||
digitalWrite(motor_pin_1, HIGH);
|
||||
digitalWrite(motor_pin_2, LOW);
|
||||
digitalWrite(motor_pin_3, HIGH);
|
||||
digitalWrite(motor_pin_4, LOW);
|
||||
break;
|
||||
case 1: // 0110
|
||||
digitalWrite(motor_pin_1, LOW);
|
||||
digitalWrite(motor_pin_2, HIGH);
|
||||
digitalWrite(motor_pin_3, HIGH);
|
||||
digitalWrite(motor_pin_4, LOW);
|
||||
break;
|
||||
case 2: //0101
|
||||
digitalWrite(motor_pin_1, LOW);
|
||||
digitalWrite(motor_pin_2, HIGH);
|
||||
digitalWrite(motor_pin_3, LOW);
|
||||
digitalWrite(motor_pin_4, HIGH);
|
||||
break;
|
||||
case 3: //1001
|
||||
digitalWrite(motor_pin_1, HIGH);
|
||||
digitalWrite(motor_pin_2, LOW);
|
||||
digitalWrite(motor_pin_3, LOW);
|
||||
digitalWrite(motor_pin_4, HIGH);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (this->pin_count == 5) {
|
||||
switch (thisStep) {
|
||||
case 0: // 01101
|
||||
digitalWrite(motor_pin_1, LOW);
|
||||
digitalWrite(motor_pin_2, HIGH);
|
||||
digitalWrite(motor_pin_3, HIGH);
|
||||
digitalWrite(motor_pin_4, LOW);
|
||||
digitalWrite(motor_pin_5, HIGH);
|
||||
break;
|
||||
case 1: // 01001
|
||||
digitalWrite(motor_pin_1, LOW);
|
||||
digitalWrite(motor_pin_2, HIGH);
|
||||
digitalWrite(motor_pin_3, LOW);
|
||||
digitalWrite(motor_pin_4, LOW);
|
||||
digitalWrite(motor_pin_5, HIGH);
|
||||
break;
|
||||
case 2: // 01011
|
||||
digitalWrite(motor_pin_1, LOW);
|
||||
digitalWrite(motor_pin_2, HIGH);
|
||||
digitalWrite(motor_pin_3, LOW);
|
||||
digitalWrite(motor_pin_4, HIGH);
|
||||
digitalWrite(motor_pin_5, HIGH);
|
||||
break;
|
||||
case 3: // 01010
|
||||
digitalWrite(motor_pin_1, LOW);
|
||||
digitalWrite(motor_pin_2, HIGH);
|
||||
digitalWrite(motor_pin_3, LOW);
|
||||
digitalWrite(motor_pin_4, HIGH);
|
||||
digitalWrite(motor_pin_5, LOW);
|
||||
break;
|
||||
case 4: // 11010
|
||||
digitalWrite(motor_pin_1, HIGH);
|
||||
digitalWrite(motor_pin_2, HIGH);
|
||||
digitalWrite(motor_pin_3, LOW);
|
||||
digitalWrite(motor_pin_4, HIGH);
|
||||
digitalWrite(motor_pin_5, LOW);
|
||||
break;
|
||||
case 5: // 10010
|
||||
digitalWrite(motor_pin_1, HIGH);
|
||||
digitalWrite(motor_pin_2, LOW);
|
||||
digitalWrite(motor_pin_3, LOW);
|
||||
digitalWrite(motor_pin_4, HIGH);
|
||||
digitalWrite(motor_pin_5, LOW);
|
||||
break;
|
||||
case 6: // 10110
|
||||
digitalWrite(motor_pin_1, HIGH);
|
||||
digitalWrite(motor_pin_2, LOW);
|
||||
digitalWrite(motor_pin_3, HIGH);
|
||||
digitalWrite(motor_pin_4, HIGH);
|
||||
digitalWrite(motor_pin_5, LOW);
|
||||
break;
|
||||
case 7: // 10100
|
||||
digitalWrite(motor_pin_1, HIGH);
|
||||
digitalWrite(motor_pin_2, LOW);
|
||||
digitalWrite(motor_pin_3, HIGH);
|
||||
digitalWrite(motor_pin_4, LOW);
|
||||
digitalWrite(motor_pin_5, LOW);
|
||||
break;
|
||||
case 8: // 10101
|
||||
digitalWrite(motor_pin_1, HIGH);
|
||||
digitalWrite(motor_pin_2, LOW);
|
||||
digitalWrite(motor_pin_3, HIGH);
|
||||
digitalWrite(motor_pin_4, LOW);
|
||||
digitalWrite(motor_pin_5, HIGH);
|
||||
break;
|
||||
case 9: // 00101
|
||||
digitalWrite(motor_pin_1, LOW);
|
||||
digitalWrite(motor_pin_2, LOW);
|
||||
digitalWrite(motor_pin_3, HIGH);
|
||||
digitalWrite(motor_pin_4, LOW);
|
||||
digitalWrite(motor_pin_5, HIGH);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
version() returns the version of the library:
|
||||
*/
|
||||
int Stepper::version(void)
|
||||
{
|
||||
return 5;
|
||||
}
|
||||
121
arduino/libraries/Stepper/src/Stepper.h
Normal file
121
arduino/libraries/Stepper/src/Stepper.h
Normal file
@@ -0,0 +1,121 @@
|
||||
/*
|
||||
* Stepper.h - Stepper library for Wiring/Arduino - Version 1.1.0
|
||||
*
|
||||
* Original library (0.1) by Tom Igoe.
|
||||
* Two-wire modifications (0.2) by Sebastian Gassner
|
||||
* Combination version (0.3) by Tom Igoe and David Mellis
|
||||
* Bug fix for four-wire (0.4) by Tom Igoe, bug fix from Noah Shibley
|
||||
* High-speed stepping mod by Eugene Kozlenko
|
||||
* Timer rollover fix by Eugene Kozlenko
|
||||
* Five phase five wire (1.1.0) by Ryan Orendorff
|
||||
*
|
||||
* This library is free software; you can redistribute it and/or
|
||||
* modify it under the terms of the GNU Lesser General Public
|
||||
* License as published by the Free Software Foundation; either
|
||||
* version 2.1 of the License, or (at your option) any later version.
|
||||
*
|
||||
* This library is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||||
* Lesser General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU Lesser General Public
|
||||
* License along with this library; if not, write to the Free Software
|
||||
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||||
*
|
||||
*
|
||||
* Drives a unipolar, bipolar, or five phase stepper motor.
|
||||
*
|
||||
* When wiring multiple stepper motors to a microcontroller, you quickly run
|
||||
* out of output pins, with each motor requiring 4 connections.
|
||||
*
|
||||
* By making use of the fact that at any time two of the four motor coils are
|
||||
* the inverse of the other two, the number of control connections can be
|
||||
* reduced from 4 to 2 for the unipolar and bipolar motors.
|
||||
*
|
||||
* A slightly modified circuit around a Darlington transistor array or an
|
||||
* L293 H-bridge connects to only 2 microcontroler pins, inverts the signals
|
||||
* received, and delivers the 4 (2 plus 2 inverted ones) output signals
|
||||
* required for driving a stepper motor. Similarly the Arduino motor shields
|
||||
* 2 direction pins may be used.
|
||||
*
|
||||
* The sequence of control signals for 5 phase, 5 control wires is as follows:
|
||||
*
|
||||
* Step C0 C1 C2 C3 C4
|
||||
* 1 0 1 1 0 1
|
||||
* 2 0 1 0 0 1
|
||||
* 3 0 1 0 1 1
|
||||
* 4 0 1 0 1 0
|
||||
* 5 1 1 0 1 0
|
||||
* 6 1 0 0 1 0
|
||||
* 7 1 0 1 1 0
|
||||
* 8 1 0 1 0 0
|
||||
* 9 1 0 1 0 1
|
||||
* 10 0 0 1 0 1
|
||||
*
|
||||
* The sequence of control signals for 4 control wires is as follows:
|
||||
*
|
||||
* Step C0 C1 C2 C3
|
||||
* 1 1 0 1 0
|
||||
* 2 0 1 1 0
|
||||
* 3 0 1 0 1
|
||||
* 4 1 0 0 1
|
||||
*
|
||||
* The sequence of controls signals for 2 control wires is as follows
|
||||
* (columns C1 and C2 from above):
|
||||
*
|
||||
* Step C0 C1
|
||||
* 1 0 1
|
||||
* 2 1 1
|
||||
* 3 1 0
|
||||
* 4 0 0
|
||||
*
|
||||
* The circuits can be found at
|
||||
*
|
||||
* http://www.arduino.cc/en/Tutorial/Stepper
|
||||
*/
|
||||
|
||||
// ensure this library description is only included once
|
||||
#ifndef Stepper_h
|
||||
#define Stepper_h
|
||||
|
||||
// library interface description
|
||||
class Stepper {
|
||||
public:
|
||||
// constructors:
|
||||
Stepper(int number_of_steps, int motor_pin_1, int motor_pin_2);
|
||||
Stepper(int number_of_steps, int motor_pin_1, int motor_pin_2,
|
||||
int motor_pin_3, int motor_pin_4);
|
||||
Stepper(int number_of_steps, int motor_pin_1, int motor_pin_2,
|
||||
int motor_pin_3, int motor_pin_4,
|
||||
int motor_pin_5);
|
||||
|
||||
// speed setter method:
|
||||
void setSpeed(long whatSpeed);
|
||||
|
||||
// mover method:
|
||||
void step(int number_of_steps);
|
||||
|
||||
int version(void);
|
||||
|
||||
private:
|
||||
void stepMotor(int this_step);
|
||||
|
||||
int direction; // Direction of rotation
|
||||
unsigned long step_delay; // delay between steps, in ms, based on speed
|
||||
int number_of_steps; // total number of steps this motor can take
|
||||
int pin_count; // how many pins are in use.
|
||||
int step_number; // which step the motor is on
|
||||
|
||||
// motor pin numbers:
|
||||
int motor_pin_1;
|
||||
int motor_pin_2;
|
||||
int motor_pin_3;
|
||||
int motor_pin_4;
|
||||
int motor_pin_5; // Only 5 phase motor
|
||||
|
||||
unsigned long last_step_time; // time stamp in us of when the last step was taken
|
||||
};
|
||||
|
||||
#endif
|
||||
|
||||
Reference in New Issue
Block a user