// stop watch2 for NXT + BricxCC
// by takuya matsubara
#include "NXCDefs.h"

byte vram[32];

           // 01234012340123401234012340123401234012340123401234
string font0=" xxx   x   xxx  xxx    x xxxxx  xxxxxxxx xxx  xxx ";
string font1="x   x xx  x   xx   x  xx x     x       xx   xx   x";
string font2="x   x  x  x   x    x x x x    x        xx   xx   x";
string font3="x   x  x     x  xxx x  x xxxx xxxx     x xxx x   x";
string font4="x   x  x    x      xxxxxx    xx   x   x x   x xxxx";
string font5="x   x  x   x       x   x     xx   x  x  x   x   x ";
string font6="x   x  x  x    x   x   x     xx   x x   x   x  x  ";
string font7=" xxx  xxx xxxxx xxx    x xxxx  xxx x     xxx  x   ";

void put_num(char x,int num)
{
  byte tmp;
  byte cnt=5;
  int readcnt = 0;     //sensor to NXT. input bytes

  num *= 5;

  while(cnt--){
     tmp = 0;
     if(SubStr(font0,num,1) !=" ") tmp |= (0x01 << 0);
     if(SubStr(font1,num,1) !=" ") tmp |= (0x01 << 1);
     if(SubStr(font2,num,1) !=" ") tmp |= (0x01 << 2);
     if(SubStr(font3,num,1) !=" ") tmp |= (0x01 << 3);
     if(SubStr(font4,num,1) !=" ") tmp |= (0x01 << 4);
     if(SubStr(font5,num,1) !=" ") tmp |= (0x01 << 5);
     if(SubStr(font6,num,1) !=" ") tmp |= (0x01 << 6);
     if(SubStr(font7,num,1) !=" ") tmp |= (0x01 << 7);
     vram[x] = tmp;
     x++;
     num++;
  }
}

void put_vram(void)
{
   int i,j;
   
   ClearScreen();
   for(i=0;i<(100/4);i++){
      for(j=0;j<8;j++){
         if((0x80>>j)& vram[i]){
            RectOut(i*4, j*6, 3, 5);
         }
      }
   }
}

void put_time(int time)
{
     put_num( 0,(time / 1000)%10);
     put_num( 6,(time / 100)%10);
     put_num(14,(time / 10)%10);
     put_num(20,time % 10);
     put_vram();
}

void wait_button_press(void){
  while(ButtonPressed(BTNCENTER, false)==1); //until OFF
  while(ButtonPressed(BTNCENTER, false)==0); //until ON
}

#define THRESHOLD 30

task main()
{
  int time;
  long nexttick;
  int btn_disable;
  int a1,a2,b1,b2;

  TextOut(0,LCD_LINE1,"Stop Watch");
  TextOut(0,LCD_LINE2,"(light sensor)");
  TextOut(0,LCD_LINE3,"IN2:start");
  TextOut(0,LCD_LINE4,"IN3:end");
  TextOut(0,LCD_LINE5,"Press Center Btn");
  wait_button_press();

  vram[12]=0x80;  //point

  SetSensorType(S2, SENSOR_TYPE_LIGHT_ACTIVE);
  SetSensorType(S3, SENSOR_TYPE_LIGHT_ACTIVE);
  Wait(1000);

  while(1){
    PlayTone(200,50);
    a1 = Sensor(S2);
    b1 = Sensor(S3);

    time = 0;
    put_time(time);
    TextOut(0,LCD_LINE1,"READY...");

    while(1){
      a2 = Sensor(S2);
      if(abs(a2-a1)>THRESHOLD)break;
    }

    PlayTone(400,50);
    nexttick = CurrentTick();
    ClearScreen();
    TextOut(0,LCD_LINE2,"START");

    btn_disable=1;
    while(1){
//      put_time(time);
      b2 = Sensor(S3);
      if(abs(b2-b1)>THRESHOLD)break;
    }
    time = CurrentTick() - nexttick;
    time /= 10;
    if(time > 9999)time=9999;
    put_time(time);
    PlayTone(500,50);
    TextOut(0,LCD_LINE1,"PUSH BUTTON");
    wait_button_press();
  }
}