nhanpsp.c

Embedded camera control program.

#device  PIC16F877 *=16 ADC=10
#include <16f877.h>
#include <math.h>
#include <stdlib.h>

#fuses hs,nowdt,noprotect,put,nolvp,brownout
#use delay(clock=20000000) 	// 20 MhZ
#use rs232(baud=38400,parity=N,xmit=PIN_C6, rcv=PIN_C7)

#use fast_io(D)
#use fast_io(E)

int frame1[3];
int ip=0;
int i;
boolean Rev_OK=0;
int set_value1=0;
int set_value2=0;
//----------------------
#INT_PSP
void psp_isr()
{
 while(!psp_input_full()) ;   // Wait data
 if ( !psp_overflow() )
 {

  //delay_us(1);
  frame1[ip] = psp_data;
  if (frame1[0]==252) ip++;

  if (ip==2)
  {
    ip=0;
    Rev_OK = 1;
    set_value1 = frame1[1];
    set_value2=frame1[2];
          }
 }
}

//----------------------

void main()
{
 char s[10];
 int j=0;

 setup_adc_ports( NO_ANALOGS);
 setup_psp(PSP_ENABLED);

 set_tris_e(0xff); // Port E Input
 set_tris_d(0xff);

 for (j=0;j<3;j++) frame1[j]=0;

 enable_interrupts(INT_PSP);
 enable_interrupts(GLOBAL);

 delay_ms(10);

 while (1)
 {
   while (!Rev_ok) ;
   Rev_ok = False;

   printf("%u   ",set_value1);
   printf("%u   ",set_value2);
   delay_ms (10);
 }

}