官方提供了一些库,使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: }