void Camera::Initialize()
{

      // IR sensor initialize
    Write_2bytes(0x30, 0x01); delay(10);
    Write_2bytes(0x30, 0x08); delay(10);
    Write_2bytes(0x06, 0x90); delay(10);
    Write_2bytes(0x08, 0xC0); delay(10);
    Write_2bytes(0x1A, 0x40); delay(10);
    Write_2bytes(0x33, 0x33); delay(10);
    delay(1000);
}
// init the PVision sensor
void Camera_init(void)
{
    Blob1.number = 1;
	Blob2.number = 2;
	Blob3.number = 3;
	Blob4.number = 4;
	
	IRsensorAddress = 0xB0;
    IRslaveAddress = IRsensorAddress >> 1;			// This results in 0x21 as the address to pass to TWI
	
	I2CM_sda_SetDriveMode(I2CM_sda_DM_RES_UP);
	I2CM_scl_SetDriveMode(I2CM_scl_DM_RES_UP);
	
    // IR sensor initialize
    Write_2bytes(0x30,0x01); CyDelay(10);
    Write_2bytes(0x30,0x08); CyDelay(10);
    Write_2bytes(0x06,0x90); CyDelay(10);
    Write_2bytes(0x08,0xC0); CyDelay(10);
    Write_2bytes(0x1A,0x40); CyDelay(10);
    Write_2bytes(0x33,0x33); CyDelay(10);
    CyDelay(100);
}