-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathmain.c
More file actions
189 lines (153 loc) · 4.52 KB
/
Copy pathmain.c
File metadata and controls
189 lines (153 loc) · 4.52 KB
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
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
// main.c
// @description Sonar Project - Analog Electronics (Fall 2019)
//
// @author Andrew Siemer <andrew.siemer@eagles.oc.edu>
// @version 12.6.19
//
#include <p30f3013.h>
#include <string.h>
#include "aliases.h"
#include "utilities.h"
#include "definitions.h"
void setupPins() {
/* State Switch */
pin3Direction = INPUT;
pin3Type = DIGITAL;
/* Transmitter State */
pin4Direction = OUTPUT;
pin4Type = DIGITAL;
/* Timer State */
pin12Direction = INPUT;
/* LCD Display */
pin23Type = DIGITAL;
pin24Type = DIGITAL;
pin25Type = DIGITAL;
pin26Type = DIGITAL;
pin16Direction = OUTPUT;
pin21Direction = OUTPUT;
pin22Direction = OUTPUT;
pin23Direction = OUTPUT;
pin24Direction = OUTPUT;
pin25Direction = OUTPUT;
pin26Direction = OUTPUT;
}
int main() {
float data[50] = {0},
distance;
int countBadValues = 0;
char const * OUT;
char onesBuf[3],
tensBuf[4];
initializeUART();
setupPins();
initializeLCD();
displayBootScreen();
delay(2500);
while(1) { //forever
if (sensingState) {
displaySensingScreen();
while(sensingState) {
writeToLCDXY(4, 11, getPotValue());
resetRecieverTrigger();
transmitterState = 1; //turn on transmitter
startDelayTimer();
while (readRecieverTrigger() == 0)
if (readDelayTimer() > 25500) break; //reset if timer overflow
stopDelayTimer();
transmitterState = 0;
distance = ((float)readDelayTimer() * 0.00353 ) - 1.27;
if (distance > 1 && distance < 30) {
countBadValues = 0;
pushBack(data, distance);
distance = getAveragedValue(data);
distance = ((float)((int)(distance * 10 + 0.5))) / 10; //round distance to nearest tenth of an inch
if (distance >= 10) {
sprintf(tensBuf,"%0.1f", distance);
OUT = tensBuf;
writeToLCDXY(2, 6, OUT);
} else {
sprintf(onesBuf,"%0.1f", distance);
OUT = onesBuf;
writeToLCDXY(2, 6, " "); //account or less digits when number is less than 10
writeToLCDXY(2, 7, OUT);
}
}
else {
if (countBadValues > 3) {
writeToLCDXY(2, 6, "----");
} else {
countBadValues++;
}
}
delay(10); //slow down the samples
}
}
else {
transmitterState = 0; //turn off transmitter
displayIdleScreen();
while (!sensingState); //wait for sensing switch to change
}
}
return (0);
}
float getAveragedValue(float *data){
int numAverageValues, index;
if (getPotValue() == "HIGH")
numAverageValues = 45;
else if (getPotValue() == "LOW ")
numAverageValues = 15;
else
numAverageValues = 1; //only use current sample
float distance = 0;
for (index = 0; index < numAverageValues; index++)
distance += data[index]; //add up values to be averaged
distance = distance/numAverageValues; //divide total distance by number of indexes to get average
return distance;
}
char const * getPotValue() {
int i = getAnalogValue(0); //get ADC value on Pin 2 (AN0)
static char const * AVERAGING;
if (i > 3200)
AVERAGING = "HIGH";
else if (i > 1600)
AVERAGING = "LOW ";
else
AVERAGING = "OFF ";
return AVERAGING;
}
void pushBack(float *data, float value) {
int i;
for(i = 49; i > 0; i--) {
data[i] = data[i-1];
}
data[0] = value;
}
void displayBootScreen() {
clearLCD();
char const * TEXT = "Sonar";
writeToLCDXY(2, 5, TEXT);
TEXT = "Ranging";
writeToLCDXY(3, 4, TEXT);
TEXT = "...";
writeToLCDXY(4, 13, TEXT);
}
void displayIdleScreen() {
clearLCD();
char const * TEXT = "*IDLE*";
writeToLCDXY(1, 5, TEXT);
TEXT = "Toggle State";
writeToLCDXY(2, 2, TEXT);
TEXT = "Switch to Begin";
writeToLCDXY(3, 0, TEXT);
TEXT = "Sensing";
writeToLCDXY(4, 4, TEXT);
}
void displaySensingScreen() {
clearLCD();
char const * TEXT = "*SENSING*";
writeToLCDXY(1, 3, TEXT);
TEXT = "Dist: (IN)";
writeToLCDXY(2, 0, TEXT);
TEXT = "Averaging:";
writeToLCDXY(4, 0, TEXT);
}