root / scout_avr / src / stepper.cpp @ 18db4dfa
History | View | Annotate | Download (2.01 KB)
1 |
extern "C" |
---|---|
2 |
{ |
3 |
#include <avr/io.h> |
4 |
#include <util/delay.h> |
5 |
} |
6 |
#include "stepper.h" |
7 |
|
8 |
/* Stepper Motor:
|
9 |
* Provides interface to stepper motor.
|
10 |
* Can set direction. Outputs pulse to stepper upon call of step func
|
11 |
* Also provides variable speed sweep
|
12 |
*/
|
13 |
|
14 |
struct step_t {
|
15 |
int pos; // position in rotation. |
16 |
int dir; // direction. -1 CCW. 1 CW. 0 OFF |
17 |
int step_size; // amount to add to position each step |
18 |
int ccw;
|
19 |
int cw;
|
20 |
} step; |
21 |
|
22 |
|
23 |
void step_init()
|
24 |
{ |
25 |
/* init pos and dir to 0 */
|
26 |
step.pos = 0;
|
27 |
step.dir = 0;
|
28 |
|
29 |
//set control pins as output
|
30 |
DDRD |= ((1<<S_STEP) | (1<<S_DIR)); |
31 |
DDRB |= ((1<<S_MS));
|
32 |
|
33 |
/* this is connected to ENABLE temporarily */
|
34 |
DDRF |= _BV(S_EN); |
35 |
step_disable(); |
36 |
|
37 |
//initiate to full steps
|
38 |
step_set_size(STEP_WHOLE); |
39 |
|
40 |
//initiate the step pin to be low. stepper steps on low to high
|
41 |
PORTD &= (~(1<<S_STEP));
|
42 |
} |
43 |
|
44 |
void step_enable()
|
45 |
{ |
46 |
PORTF &= ~_BV(S_EN); |
47 |
} |
48 |
|
49 |
void step_disable()
|
50 |
{ |
51 |
PORTF |= _BV(S_EN); |
52 |
} |
53 |
|
54 |
void step_set_size(char size) |
55 |
{ |
56 |
if (size == STEP_WHOLE)
|
57 |
{ |
58 |
PORTB &= ~_BV(S_MS); |
59 |
step.step_size = 2;
|
60 |
} |
61 |
else
|
62 |
{ |
63 |
PORTB |= _BV(S_MS); |
64 |
step.step_size = 1;
|
65 |
} |
66 |
} |
67 |
|
68 |
/* set direction pin */
|
69 |
void step_dir(int dir) |
70 |
{ |
71 |
step.dir = dir; |
72 |
switch(dir)
|
73 |
{ |
74 |
case 1: |
75 |
PORTD |= (1<<S_DIR);
|
76 |
break;
|
77 |
case -1: |
78 |
PORTD &= (~(1<<S_DIR));
|
79 |
break;
|
80 |
} |
81 |
} |
82 |
|
83 |
void step_do_step()
|
84 |
{ |
85 |
if(step.dir==0) return; //do not step if not enabled |
86 |
PORTD |= (1<<S_STEP); //step once |
87 |
_delay_us(1); //conform with step timing |
88 |
PORTD &= (~(1<<S_STEP)); //bring the step bin back down |
89 |
if(step.dir==1) step.pos += step.step_size; |
90 |
else step.pos -= step.step_size;
|
91 |
} |
92 |
|
93 |
void step_flush()
|
94 |
{ |
95 |
PORTD &= (~(1<<S_STEP)); //bring the step bin back down |
96 |
} |
97 |
|
98 |
//ccw must be less than 0 and cw must be greater than 0
|
99 |
void step_sweep_bounds(int ccw, int cw) |
100 |
{ |
101 |
step.ccw = ccw; |
102 |
step.cw = cw; |
103 |
} |
104 |
|
105 |
void step_sweep()
|
106 |
{ |
107 |
step_do_step(); |
108 |
if((step.dir == 1) && (step.cw <= step.pos)) step_dir(-1); |
109 |
else if((step.dir == -1) && (step.ccw >= step.pos)) step_dir(1); |
110 |
} |
111 |
|
112 |
int step_get_pos()
|
113 |
{ |
114 |
return step.pos;
|
115 |
} |