Revision 1543
Added a bunch of debug prints to the library
rangefinder.c | ||
---|---|---|
122 | 122 |
**/ |
123 | 123 |
int range_init(void) |
124 | 124 |
{ |
125 |
if(range_initd) |
|
125 |
if(range_initd) { |
|
126 |
DRAGONFLY_DEBUG_PRINT("ERROR: rangefinders not init'd\r\n"); |
|
126 | 127 |
return ERROR_INIT_ALREADY_INITD; |
128 |
} |
|
127 | 129 |
|
128 | 130 |
digital_output(_PIN_B4,0); |
129 | 131 |
|
... | ... | |
143 | 145 |
* @see range_init |
144 | 146 |
**/ |
145 | 147 |
int range_read_distance(int range_id) { |
146 |
if(!range_initd) |
|
148 |
if(!range_initd) { |
|
149 |
DRAGONFLY_DEBUG_PRINT("ERROR: rangefinders not init'd\r\n"); |
|
147 | 150 |
return -3; |
151 |
} |
|
148 | 152 |
|
149 | 153 |
return linearize_distance(analog8(range_id)); |
150 | 154 |
} |
Also available in: Unified diff