diff --git a/afsk/telem.c b/afsk/telem.c index 9d9a369a..8e4815ba 100644 --- a/afsk/telem.c +++ b/afsk/telem.c @@ -170,6 +170,40 @@ int main(int argc, char *argv[]) { wiringPiSetup (); printf("\n"); + + pinMode (2, INPUT); + pullUpDnControl (2, PUD_UP); + + if (digitalRead(2) != HIGH) + { + printf("vB3 with TFB Present\n"); + } + else + { + pinMode (3, INPUT); + pullUpDnControl (3, PUD_UP); + + if (digitalRead(3) != HIGH) + { + printf("vB4 Present\n"); + + } + else + { + pinMode (26, INPUT); + pullUpDnControl (26, PUD_UP); + + if (digitalRead(26) != HIGH) + { + printf("vB5 Present\n"); + + } + else + { + printf("VB3 Present\n"); + } + } + } sensorV = config_sensor("/dev/i2c-1", 0x40, 400); readingV = read_sensor_data(sensorV);