void init_ultrasonic(int echo, int trig)
{
set_pin_mode(echo, IN);
set_pin_mode(trig, OUT);
set_pin(trig, LOW);
//TRISEbits.TRISE8 = 1; // ECHO to A2, NU32 input pin
//TRISEbits.TRISE9 = 0; // TRIG to A3, NU32 output pin
//LATEbits.LATE9 = 0; // start off
}
void keypad_init (void)
{
for (int j=0; j < CFG_MAX_BUTTONS; j++)
{
set_pin_mode (config.interface_cp_btn_pin[j], INPUT);
}
}
int main(int argc,char *argv[])
{
if (!open_connection(0))
{
printf("open failed on comport\n");
return 2;
}
double gpslat = 48.8566140;
double gpslng = 2.3522219;
int pin;
for (pin=13; pin<=16; pin++)
set_pin_mode(tst_board,pin,GB_PIN_ADC);
for (pin=1; pin<=7; pin++)
set_pin_mode(tst_board,pin,GB_PIN_OUTPUT);
while (1)
{
printf("ADC0:%5.10f\n",read_adc(tst_board,0));
printf("ADC1:%5.10f\n",read_adc(tst_board,1));
printf("ADC2:%5.10f\n",read_adc(tst_board,2));
printf("ADC3:%5.10f\n",read_adc(tst_board,3));
printf("GPSLat:%5.10f\n",gpslat);
printf("GPSLng:%5.10f\n",gpslng);
printf("\n");
fflush(stdout);
gpslat -= 0.0002;
gpslng += 0.0002;
sleep(1);
}
return 1;
}
