关于Arduino 步进电机Stepper库的一些想法

时间:2023-03-09 15:25:01
关于Arduino 步进电机Stepper库的一些想法

官方提供了一些库,使Arduino入门起来更加快速,我们连原理都不用懂,就能通过函数控制终端。但是,这样也带来了很多的缺陷,比如,库函数的功能有限,有些无法实现。然后还有库函数因为要考虑其他的情况,你是四线的还是两线的,于是整个程序就会写的很麻烦。

我想用Sony无线手柄控制电机停止、顺时针、逆时针转动,按Start键能启动。但是库里根本没有这个功能。

还有我发现,一旦我的无线手柄里面加入了电机的相关程序,无线手柄与接收器的通信就会变迟钝,往往需要按着才能等到电机反向转动,而且有时候我改变方向,结果它转了一圈又回到原来方向了,完全就是乱套了。不过,中断还是能照常反应,但是还是会出现延迟现象。

后来看了一下代码,库文件只有在转完一圈才会跳出循环,所以按键的消息根本没办法马上反应。

后来就直接根据库文件写了函数,反应很迅速!!!!

下面是库文件的函数

   1: #ifndef Stepper_h

   2: #define Stepper_h

   3:  

   4: // library interface description

   5: class Stepper {

   6:   public:

   7:     // constructors:

   8:     Stepper(int number_of_steps, int motor_pin_1, int motor_pin_2);

   9:     Stepper(int number_of_steps, int motor_pin_1, int motor_pin_2, int motor_pin_3, int motor_pin_4);

  10:  

  11:     // speed setter method:

  12:     void setSpeed(long whatSpeed);

  13:  

  14:     // mover method:

  15:     void step(int number_of_steps);

  16:  

  17:     int version(void);

  18:  

  19:   private:

  20:     void stepMotor(int this_step);

  21:     

  22:     int direction;        // Direction of rotation

  23:     int speed;          // Speed in RPMs

  24:     unsigned long step_delay;    // delay between steps, in ms, based on speed

  25:     int number_of_steps;      // total number of steps this motor can take

  26:     int pin_count;        // whether you're driving the motor with 2 or 4 pins

  27:     int step_number;        // which step the motor is on

  28:     

  29:     // motor pin numbers:

  30:     int motor_pin_1;

  31:     int motor_pin_2;

  32:     int motor_pin_3;

  33:     int motor_pin_4;

  34:     

  35:     long last_step_time;      // time stamp in ms of when the last step was taken

  36: };

  37:  

  38: #endif

  39:  

   1: #include "Arduino.h"

   2: #include "Stepper.h"

   3:  

   4: /*

   5:  * two-wire constructor.

   6:  * Sets which wires should control the motor.

   7:  */

   8: Stepper::Stepper(int number_of_steps, int motor_pin_1, int motor_pin_2)

   9: {

  10:   this->step_number = 0;      // which step the motor is on

  11:   this->speed = 0;        // the motor speed, in revolutions per minute

  12:   this->direction = 0;      // motor direction

  13:   this->last_step_time = 0;    // time stamp in ms of the last step taken

  14:   this->number_of_steps = number_of_steps;    // total number of steps for this motor

  15:   

  16:   // Arduino pins for the motor control connection:

  17:   this->motor_pin_1 = motor_pin_1;

  18:   this->motor_pin_2 = motor_pin_2;

  19:  

  20:   // setup the pins on the microcontroller:

  21:   pinMode(this->motor_pin_1, OUTPUT);

  22:   pinMode(this->motor_pin_2, OUTPUT);

  23:   

  24:   // When there are only 2 pins, set the other two to 0:

  25:   this->motor_pin_3 = 0;

  26:   this->motor_pin_4 = 0;

  27:   

  28:   // pin_count is used by the stepMotor() method:

  29:   this->pin_count = 2;

  30: }

  31:  

  32:  

  33: /*

  34:  *   constructor for four-pin version

  35:  *   Sets which wires should control the motor.

  36:  */

  37:  

  38: Stepper::Stepper(int number_of_steps, int motor_pin_1, int motor_pin_2, int motor_pin_3, int motor_pin_4)

  39: {

  40:   this->step_number = 0;      // which step the motor is on

  41:   this->speed = 0;        // the motor speed, in revolutions per minute

  42:   this->direction = 0;      // motor direction

  43:   this->last_step_time = 0;    // time stamp in ms of the last step taken

  44:   this->number_of_steps = number_of_steps;    // total number of steps for this motor

  45:   

  46:   // Arduino pins for the motor control connection:

  47:   this->motor_pin_1 = motor_pin_1;

  48:   this->motor_pin_2 = motor_pin_2;

  49:   this->motor_pin_3 = motor_pin_3;

  50:   this->motor_pin_4 = motor_pin_4;

  51:  

  52:   // setup the pins on the microcontroller:

  53:   pinMode(this->motor_pin_1, OUTPUT);

  54:   pinMode(this->motor_pin_2, OUTPUT);

  55:   pinMode(this->motor_pin_3, OUTPUT);

  56:   pinMode(this->motor_pin_4, OUTPUT);

  57:  

  58:   // pin_count is used by the stepMotor() method:  

  59:   this->pin_count = 4;  

  60: }

  61:  

  62: /*

  63:   Sets the speed in revs per minute

  64: 

  65: */

  66: void Stepper::setSpeed(long whatSpeed)

  67: {

  68:   this->step_delay = 60L * 1000L / this->number_of_steps / whatSpeed;

  69: }

  70:  

  71: /*

  72:   Moves the motor steps_to_move steps.  If the number is negative, 

  73:    the motor moves in the reverse direction.

  74:  */

  75: void Stepper::step(int steps_to_move)

  76: {  

  77:   int steps_left = abs(steps_to_move);  // how many steps to take

  78:   

  79:   // determine direction based on whether steps_to_mode is + or -:

  80:   if (steps_to_move > 0) {this->direction = 1;}

  81:   if (steps_to_move < 0) {this->direction = 0;}

  82:     

  83:     

  84:   // decrement the number of steps, moving one step each time:

  85:   while(steps_left > 0) {

  86:   // move only if the appropriate delay has passed:

  87:   if (millis() - this->last_step_time >= this->step_delay) {

  88:       // get the timeStamp of when you stepped:

  89:       this->last_step_time = millis();

  90:       // increment or decrement the step number,

  91:       // depending on direction:

  92:       if (this->direction == 1) {

  93:         this->step_number++;

  94:         if (this->step_number == this->number_of_steps) {

  95:           this->step_number = 0;

  96:         }

  97:       } 

  98:       else { 

  99:         if (this->step_number == 0) {

 100:           this->step_number = this->number_of_steps;

 101:         }

 102:         this->step_number--;

 103:       }

 104:       // decrement the steps left:

 105:       steps_left--;

 106:       // step the motor to step number 0, 1, 2, or 3:

 107:       stepMotor(this->step_number % 4);

 108:     }

 109:   }

 110: }

 111:  

 112: /*

 113:  * Moves the motor forward or backwards.

 114:  */

 115: void Stepper::stepMotor(int thisStep)

 116: {

 117:   if (this->pin_count == 2) {

 118:     switch (thisStep) {

 119:       case 0: /* 01 */

 120:       digitalWrite(motor_pin_1, LOW);

 121:       digitalWrite(motor_pin_2, HIGH);

 122:       break;

 123:       case 1: /* 11 */

 124:       digitalWrite(motor_pin_1, HIGH);

 125:       digitalWrite(motor_pin_2, HIGH);

 126:       break;

 127:       case 2: /* 10 */

 128:       digitalWrite(motor_pin_1, HIGH);

 129:       digitalWrite(motor_pin_2, LOW);

 130:       break;

 131:       case 3: /* 00 */

 132:       digitalWrite(motor_pin_1, LOW);

 133:       digitalWrite(motor_pin_2, LOW);

 134:       break;

 135:     } 

 136:   }

 137:   if (this->pin_count == 4) {

 138:     switch (thisStep) {

 139:       case 0:    // 1010

 140:       digitalWrite(motor_pin_1, HIGH);

 141:       digitalWrite(motor_pin_2, LOW);

 142:       digitalWrite(motor_pin_3, HIGH);

 143:       digitalWrite(motor_pin_4, LOW);

 144:       break;

 145:       case 1:    // 0110

 146:       digitalWrite(motor_pin_1, LOW);

 147:       digitalWrite(motor_pin_2, HIGH);

 148:       digitalWrite(motor_pin_3, HIGH);

 149:       digitalWrite(motor_pin_4, LOW);

 150:       break;

 151:       case 2:    //0101

 152:       digitalWrite(motor_pin_1, LOW);

 153:       digitalWrite(motor_pin_2, HIGH);

 154:       digitalWrite(motor_pin_3, LOW);

 155:       digitalWrite(motor_pin_4, HIGH);

 156:       break;

 157:       case 3:    //1001

 158:       digitalWrite(motor_pin_1, HIGH);

 159:       digitalWrite(motor_pin_2, LOW);

 160:       digitalWrite(motor_pin_3, LOW);

 161:       digitalWrite(motor_pin_4, HIGH);

 162:       break;

 163:     } 

 164:   }

 165: }

 166:  

 167: /*

 168:   version() returns the version of the library:

 169: */

 170: int Stepper::version(void)

 171: {

 172:   return 4;

 173: }