You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
63 lines
1.2 KiB
63 lines
1.2 KiB
/* |
|
ADS7844 register emulation |
|
Code by Andrew Tridgell November 2011 |
|
*/ |
|
|
|
#ifndef _SITL_ADC_H |
|
#define _SITL_ADC_H |
|
|
|
// this implements the UDR2 register |
|
struct ADC_UDR2 { |
|
uint16_t value, next_value; |
|
uint8_t idx; |
|
uint16_t channels[8]; |
|
|
|
ADC_UDR2() { |
|
// constructor |
|
for (uint8_t i=0; i<8; i++) { |
|
channels[i] = 0xFFFF; |
|
} |
|
value = next_value = 0; |
|
idx = 0; |
|
} |
|
|
|
/* |
|
assignment of UDR2 selects which ADC channel |
|
to output next |
|
*/ |
|
ADC_UDR2& operator=(uint8_t cmd) { |
|
switch (cmd) { |
|
case 0x87: next_value = channels[0]; break; |
|
case 0xC7: next_value = channels[1]; break; |
|
case 0x97: next_value = channels[2]; break; |
|
case 0xD7: next_value = channels[3]; break; |
|
case 0xA7: next_value = channels[4]; break; |
|
case 0xE7: next_value = channels[5]; break; |
|
case 0xB7: next_value = channels[6]; break; |
|
case 0xF7: next_value = channels[7]; break; |
|
} |
|
return *this; |
|
} |
|
|
|
/* |
|
read from UDR2 fetches a byte from the channel |
|
*/ |
|
operator int() { |
|
switch (idx) { |
|
case 0: idx++; return(value>>8); |
|
case 1: idx++; return(value&0xFF); |
|
} |
|
value = next_value; |
|
idx=0; |
|
return(value>>8); |
|
} |
|
|
|
/* |
|
interface to set a channel value from SITL |
|
*/ |
|
void set(uint8_t i, uint16_t v) { |
|
channels[i] = v; |
|
} |
|
}; |
|
|
|
#endif // _SITL_ADC_H
|
|
|