Mindboards

Code: Select all

#define I2C_ADDR  0x02
#define I2C_REG   0x00

#define MAXREADS  1000

#define DO_I2C_REQUEST \
  asm { \
    syscall 21, __CLSWArgs0 \
    doloopWhilePending2: \
    syscall 23, __CLSCSArgs0 \
    brcmp EQ, doloopWhilePending2, __CLSCSArgs0.Result, 32 \
    syscall 22, __CLSRArgs0 \
  }

#define DO_I2C_REQUEST_WITH_YIELD \
  asm { \
    syscall 21, __CLSWArgs0 \
    doloopWhilePending2: \
    wait2 0, NA \
    syscall 23, __CLSCSArgs0 \
    brcmp EQ, doloopWhilePending2, __CLSCSArgs0.Result, 32 \
    syscall 22, __CLSRArgs0 \
  }

int time_taken[16];

int getbtn() {
  int result = -1;
  if (ButtonPressed(BTN1, false))
    result = BTN1;
  else if (ButtonPressed(BTN2, false))
    result = BTN2;
  else if (ButtonPressed(BTN3, false))
    result = BTN3;
  else if (ButtonPressed(BTN4, false))
    result = BTN4;
  return result;
}

void debounce() {
  while(getbtn() != -1) {
     Wait(MS_10);
  }
}

void displayStats(int index) {
  TextOut(0, LCD_LINE1, FormatNum("Size:    %4d B", index + 1), true);
	TextOut(0, LCD_LINE8, FormatNum("Time:    %4d ms", time_taken[index]));
}

task main() {
  SetSleepTime(30);
  SetSensorLowspeed(S1);
  byte I2CRequest[] = {I2C_ADDR, I2C_REG};
  byte I2CReply[];
  int index = 0;

  TextOut(0, LCD_LINE1, "NXC");
  TextOut(0, LCD_LINE2, "I2C Test");

	for (int readsize = 1; readsize <= 16; readsize++) {
	  TextOut(0, LCD_LINE5, FormatNum("Read Size: %2d", readsize));
/*
    asm {
  	  set __CLSCSArgs0.Port, 0
     	set __CLSWArgs0.Port, 0
     	set __CLSRArgs0.Port, 0
     	mov __CLSWArgs0.ReturnLen, readsize
     	mov __CLSRArgs0.BufferLen, readsize
     	mov __CLSWArgs0.Buffer, I2CRequest
  	}
*/
	  unsigned long tick = CurrentTick();
	  repeat(1000) {
//	  for (int readings = 0; readings < MAXREADS; readings++) {

//      DO_I2C_REQUEST
//      DO_I2C_REQUEST_WITH_YIELD

	  	while (LowspeedCheckStatus(S1) == STAT_COMM_PENDING);           // Wait for I2C bus to be ready
      I2CWrite(S1, readsize, I2CRequest); // Send the message
	  	while (LowspeedCheckStatus(S1) == STAT_COMM_PENDING);           // Wait for I2C bus to be ready
	  	I2CRead(S1, readsize, I2CReply);

	  }
	  time_taken[readsize-1] = CurrentTick()-tick;
	  PlaySound(SOUND_CLICK);
	}

	displayStats(index);
	while (true) {
    int nNxtButtonPressed = getbtn();
		if (nNxtButtonPressed == BTNRIGHT) {
			if (index < 15)
			  index++;
			else
			  index = 0;
		} else if(nNxtButtonPressed == BTNLEFT) {
				if (index > 0)
			    index--;
			  else
			    index = 15;
    }
	  debounce();
	  displayStats(index);
  }
}