Changes between Version 2 and Version 3 of R1350N


Ignore:
Timestamp:
Jul 18, 2012 5:08:13 PM (7 years ago)
Author:
maki
Comment:

--

Legend:

Unmodified
Added
Removed
Modified
  • R1350N

    v2 v3  
    7474    byte data = Serial.read();
    7575    switch (state) {
    76       case 0:
    77         if (data == 0xaa) state++;
    78         break;
    79       case 1:
    80         if (data == 0x00) state++;
    81         else {
    82           counter = 0;
    83           state = 0;
     76    case 0:
     77      if (data == 0xaa) {
     78        state++;
     79      }
     80      break;
     81    case 1:
     82      if (data == 0x00) {
     83        state++;
     84      }
     85      else {
     86        counter = 0;
     87        state = 0;
     88      }
     89      break;
     90    case 2:
     91      buffer[counter++] = data;
     92      if (counter >= 13) {
     93        int sum = 0;
     94        for (int i = 0; i < 11; i++) sum += buffer[i];
     95        if ((sum & 0xff) == buffer[12]) {
     96          lcd.clear();
     97          disp5(0, 0, "A:", (buffer[2] << 8) | buffer[1]);  // angle
     98          disp5(0, 1, "X:", (buffer[6] << 8) | buffer[5]);  // accX
     99          disp5(9, 1, "Y:", (buffer[8] << 8) | buffer[7]);  // accY
     100          disp5(9, 0, "Z:", (buffer[10] << 8) | buffer[9]);  // accZ
     101          delay(100);
     102          Serial.flush();
    84103        }
    85         break;
    86       case 2:
    87         buffer[counter++] = data;
    88         if (counter >= 13) {
    89           int sum = 0;
    90           for (int i = 0;i < 11;i++) sum += buffer[i];
    91           if ((sum & 0xff) == buffer[12]) {
    92             lcd.clear();
    93             disp5(0, 0, "A:", (buffer[2] << 8) | buffer[1]);  // angle
    94             disp5(0, 1, "X:", (buffer[6] << 8) | buffer[5]);  // accX
    95             disp5(9, 1, "Y:", (buffer[8] << 8) | buffer[7]);  // accY
    96             disp5(9, 0, "Z:", (buffer[10] << 8) | buffer[9]);  // accZ
    97             delay(100);
    98             Serial.flush();
    99           }
    100           state = 0;
    101           counter = 0;
    102         }
    103         break;
     104        state = 0;
     105        counter = 0;
     106      }
     107      break;
    104108    }
    105109  }
     
    110114  lcd.print(str);
    111115  posX += 6;
    112   if (abs(num) >= 10000) posX -= 4;
    113   else if (abs(num) >= 1000) posX -= 3;
    114   else if (abs(num) >= 100) posX -= 2;
    115   else if (abs(num) >= 10) posX--;
    116   if (num < 0) posX--;
     116  if (abs(num) >= 10000) {
     117    posX -= 4;
     118  }
     119  else if (abs(num) >= 1000) {
     120    posX -= 3;
     121  }
     122  else if (abs(num) >= 100) {
     123    posX -= 2;
     124  }
     125  else if (abs(num) >= 10) {
     126    posX--;
     127  }
     128  if (num < 0) {
     129    posX--;
     130  }
    117131  lcd.setCursor(posX, posY);
    118132  lcd.print(num, DEC);