Statistics
| Branch: | Revision:

scoutos / scout_avr / src / stepper.cpp @ 53349043

History | View | Annotate | Download (2.12 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
  return; // stepper is temporarily disabled for demo
47
  PORTF &= ~_BV(S_EN);
48
}
49

    
50
void step_disable()
51
{
52
  PORTF |= _BV(S_EN);
53
}
54

    
55
void step_set_size(char size)
56
{
57
  if (size == STEP_WHOLE)
58
  {
59
    PORTB &= ~_BV(S_MS);
60
    step.step_size = 2;
61
  }
62
  else
63
  {
64
    PORTB |= _BV(S_MS);
65
    step.step_size = 1;
66
  }
67
}
68

    
69
/* set direction pin */
70
void step_dir(int dir)
71
{
72
  step.dir = dir;
73
  switch(dir)
74
  {
75
    case 1:
76
      PORTD |= (1<<S_DIR);
77
      break;
78
    case -1:
79
      PORTD &= (~(1<<S_DIR));
80
      break;
81
  }
82
}
83

    
84
void step_do_step()
85
{
86
  return; // stepper is temporarily disabled for demo
87
  if(step.dir==0) return; //do not step if not enabled
88
  PORTD |= (1<<S_STEP); //step once 
89
  _delay_us(1); //conform with step timing
90
  PORTD &= (~(1<<S_STEP)); //bring the step bin back down
91
  if(step.dir==1) step.pos += step.step_size;
92
  else step.pos -= step.step_size;
93
}
94

    
95
void step_flush()
96
{
97
  PORTD &= (~(1<<S_STEP)); //bring the step bin back down
98
}
99

    
100
//ccw must be less than 0 and cw must be greater than 0
101
void step_sweep_bounds(int ccw, int cw)
102
{
103
  step.ccw = ccw;
104
  step.cw = cw;
105
}
106

    
107
void step_sweep()
108
{
109
  step_do_step();
110
  if((step.dir == 1) && (step.cw <= step.pos)) step_dir(-1);
111
  else if((step.dir == -1) && (step.ccw >= step.pos)) step_dir(1);
112
}
113

    
114
int step_get_pos()
115
{
116
  return step.pos;
117
}