encoder-simulator/encoder-simulator.ino at master · blondejamtart/encoder-simulator · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
#define PERIOD 8388608
#define RATE 128
#define SSI_RATE 2048
#define bitbang_quad(a,b) PORTB = B00000000 + a + (b << 1)
#define bitbang_data(a) PORTB = B00000000 + a + (!a << 1)
#define QUD_SAW 1
#define QUD_SIN 2
#define SSI_SAW 3
#define SSI_SIN 4

int runMode;
int ssiData;
bool* binData;
int ssiCtr = 0;


void ssi_send() {
  bitbang_data(*binData);
  binData++;
  ssiCtr++;
  if (ssiCtr == 8*sizeof(int)) {
    ssiCtr = 0;
    binData = reinterpret_cast<bool*>(&ssiData);
  }
}

void quad_saw() {
    long int ind = 0;
      int state = 0;
      int dir = 0;
      while(1) {
        ind = ind % PERIOD;
        if (ind == 0)
          dir = !dir;
        if (ind % RATE == 0) {
          switch(dir)
          {
            case 0: {
              switch(state) {
                case 0: {
                  bitbang_quad(0,0);
                  state = 1;
                  break;
                }
                case 1: {
                  bitbang_quad(1,0);
                  state = 2;
                  break;
                }
                case 2: {
                  bitbang_quad(1,1);
                  state = 3;
                  break;
                }
                case 3: {
                  bitbang_quad(0,1);
                  state = 0;
                  break;
                }
              }
              break;
            }
            case 1: {
              switch(state) {
                case 0: {
                  bitbang_quad(0,0);
                  state = 1;
                  break;
                }
                case 1: {
                  bitbang_quad(0,1);
                  state = 2;
                  break;
                }
                case 2: {
                  bitbang_quad(1,1);
                  state = 3;
                  break;
                }
                case 3: {
                  bitbang_quad(1,0);
                  state = 0;
                  break;
                }
              }
              break;
            }
          }
        }
        ind++;
      }
}

void ssi_saw() {
  while(1) {
    ssiData = (millis() % SSI_RATE) - (SSI_RATE / 2);
  }
}

void setup() {

  runMode = SSI_SAW;
  pinMode(2, INPUT_PULLUP);
  pinMode(3, INPUT_PULLUP);
  pinMode(4, INPUT_PULLUP);
  pinMode(8, OUTPUT);
  pinMode(9, OUTPUT);

  if (runMode == SSI_SAW || runMode == SSI_SIN) {
    attachInterrupt(digitalPinToInterrupt(2), ssi_send, RISING);
    //  attachInterrupt(digitalPinToInterrupt(3), increase_duty, FALLING);
    binData = reinterpret_cast<bool*>(&ssiData);
  }
}

void loop() {
  // put your main code here, to run repeatedly:
  switch(runMode) {
    case QUD_SAW: {
      quad_saw();
      break;
    }
    case QUD_SIN: {
      break;
    }
    case SSI_SAW: {
      ssi_saw();
      break;
    }
    case SSI_SIN: {
      break;
    }

  }

}