#include <stdio.h>
#include "mbed.h"
#include "MAX44000.h"
 
  I2C i2c(P3_4, P3_5);
  MAX44000 max44000(&i2c);
 
  int main(void) {
 
      while(1) {
          if (max44000.init(MAX44000::MODE_ALS_PROX, MAX44000::ALSTIM_1X, MAX44000::ALSPGA_128X, MAX44000::DRV_110) != 0) {
              printf("Error communicating with MAX44000\n");
          } else {
              printf("Initialized MAX44000\n");
              break;
          }
          wait(1);
      }
 
      while(1) {
          int alsValue = max44000.readALS();
          if(alsValue < 0) {
              printf("Error reading ALS value\n");
              continue;
          }
 
          int proxValue = max44000.readReg(MAX44000::REG_PRX_DATA);
          if(proxValue < 0) {
              printf("Error reading proximity value\n");
              continue;
          }
 
          printf("ALS = 0x%04X  Proximity = 0x%02X\n", alsValue, proxValue);
          wait(1);
      }
  }