#include "NXCDefs.h"

#define u8  unsigned char
#define s8  char
#define u16 unsigned int
#define s16 int
#define u32 unsigned long
#define s32 long

u8 pressure;
s8 result;
u8 i2c_8591_rADC2[];
u8 i2c_data[];
u8 bytes_ready;

sub pressure_sense()
{
  asm {
    arrbuild i2c_8591_rADC2, 0x90, 0x02
  }
    
  SetSensorType(IN_3, IN_TYPE_LOWSPEED_9V);
  SetSensorMode(IN_3, IN_MODE_RAW);
  ResetSensor(IN_3);

  TextOut(0,30,false,"111");

  while (true) {
    result = LowspeedStatus(IN_3, bytes_ready);
    if (result <= 0) break;
    TextOut(0,30,false,"I2C Error 1:");
    NumOut(72,30,false,result);
  }

  result = LowspeedWrite(IN_3, 1, i2c_8591_rADC2);

  while (true) {
    result = LowspeedStatus(IN_3, bytes_ready);
    if (result <= 0) break;
    TextOut(0,30,false,"I2C Error 2:");
    NumOut(72,30,false,result);
  }

  result = LowspeedRead(IN_3, 1, i2c_data);

  pressure = i2c_data[0];
  TextOut(0,0,false,"    ");  
  NumOut(0,0,false,pressure);  

}

task main()
{
  while (true) {
    pressure_sense();
  }
}