

void RS232_Write(unsigned char reg, unsigned char dat0, unsigned char dat1)
{

  unsigned char REG_H, REG_L, DAT1_H, DAT1_L, DAT2_H, DAT2_L, CHECKSUM_H, CHECKSUM_L, CHECKSUM_T, HexValue ;

  REG_H = Hex2Ascii(reg >> 4);	  // do the Upper Nibble
  REG_L = Hex2Ascii(reg  & 0x0F);	  // do the Lower Nibble

  DAT1_H = Hex2Ascii(dat0 >> 4);	  // do the Upper Nibble
  DAT1_L = Hex2Ascii(dat0  & 0x0F); // do the Lower Nibble

  DAT2_H = Hex2Ascii(dat1 >> 4);	  // do the Upper Nibble
  DAT2_L = Hex2Ascii(dat1  & 0x0F); // do the Lower Nibble

  CHECKSUM_T = (cam_header + cam_ID_H + cam_ID_L + REG_H + REG_L + DAT1_H + DAT1_L + DAT2_H + DAT2_L);

  CHECKSUM2_H = Hex2Ascii(CHECKSUM_T >> 4);	// do the Upper Nibble
  CHECKSUM_L = Hex2Ascii(CHECKSUM_T  & 0x0F);	// do the Lower Nibble
  //***********************************************************************
  uart_init();
  uart_transmit(cam_header); 	// Header
  uart_transmit(cam_ID_H); 	// ID H
  uart_transmit(cam_ID_L); 	// ID L
  uart_transmit(REG_H); 	// Register H
  uart_transmit(REG_L); 	// Register L
  uart_transmit(DAT1_H); 	// Data 1 H
  uart_transmit(DAT1_L); 	// Data 1 L
  uart_transmit(DAT2_H); 	// Data 2 H
  uart_transmit(DAT2_L); 	// Data 2 L
  uart_transmit(CHECKSUM_H); 	// Send calculated checksum 1
  uart_transmit(CHECKSUM_L); 	// Send calculated checksum 2
//***********************************************************************
}

unsigned char Hex2Ascii(unsigned char HexValue)
{
   code const unsigned char hex[16] = {'0','1','2','3','4','5','6','7','8','9','A','B','C','D','E','F'};
   if(HexValue < 16)return hex[HexValue];
   else                       return '0';
}
