| 54,14 → 54,19 |
|---|
| // + ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| // + POSSIBILITY OF SUCH DAMAGE. |
| // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| //#include <stdlib.h> |
| #include <util/delay.h> |
| #include "analog.h" |
| |
| uint8_t AccPresent = 0; |
| |
| void ADC_Init(void) |
| { |
| // The analog inputs have a VREF of 5V and a resolution of 10 bit (0...1024 counts) |
| // i.e. 4.88mV/Count |
| |
| // set PortC 0,1,2,3 as input |
| DDRC &= ~((1<<DDC3)|(1<<DDC2)|(1<<DDC1)|(1<<DDC0)); |
| // set PortC 0,1,2,3 and 6,7 as tri state |
| // set PortC 0,1,2,3 as tri state |
| PORTC &= ~((1<<PORTC3)|(1<<PORTC2)|(1<<PORTC1)|(1<<PORTC0)); |
| |
| // port PD5 and PD6 control the current direction of the test coils of the sensors |
| 78,6 → 83,22 |
|---|
| ADCSRA |= ((1<<ADEN)|(1<<ADIF)|(1<<ADPS2)|(1<<ADPS1)|(1<<ADPS0)); |
| ADMUX = 0x00; // select ADC0 |
| ADCSRA |= (1<<ADSC); // start conversion |
| |
| |
| // Check if acceleration sensor is present |
| // The output of the LIS3L02AL (MK3MAG V1.0) and the LIS344ALH (MK3MAG V1.1) is Vdd/5 +/- 10% per 1g. |
| // The Vdd is 3.0V at this board therefore the sensitivity is 0.6V/g +/-10% that corresponds to 123 counts. |
| // The offsets at 0g is VDD/2 (1.5V) that is 307 counts. |
| // that yields to an ADC range of 184 to 430 counts. |
| |
| // pullup PC2(AccX) and PC3 (AccY) |
| PORTC |= ((1<<PORTC3)|(1<<PORTC2)); |
| _delay_ms(10.0); |
| // if ADC2 and ADC 3 is larger than 1000 counts (4.88V) no load is at the pins |
| if((ADC_GetValue(ADC2) > 1000) && (ADC_GetValue(ADC3) > 1000)) AccPresent = 0; |
| else AccPresent = 1; |
| // set port back to tristate |
| PORTC &= ~((1<<PORTC3)|(1<<PORTC2)); |
| } |
| |
| |
| 84,11 → 105,11 |
|---|
| uint16_t ADC_GetValue(ADChannel_t channel) |
| { |
| uint16_t value = 0; |
| ADMUX = channel; // set muxer bits |
| ADCSRA |= (1<<ADIF); // clear ready-flag |
| ADCSRA |= (1<<ADSC); // start conversion |
| ADMUX = channel; // set muxer bits |
| ADCSRA |= (1<<ADIF); // clear ready-flag |
| ADCSRA |= (1<<ADSC); // start conversion |
| while (((ADCSRA & (1<<ADIF)) == 0)); // wait for end of conversion |
| value = ADCW; // read adc result |
| value = ADCW; // read adc result |
| return(value); |
| } |
| |