// startup sequence for sdsc cards:
// a-b-c-d-f (loop til 0) - d
// write - h
// read - i
// card data - g
// serial test - e
// reload write buffer with random data - m
// compare read to write buffers - k
// read multiple blocks - n
// write multiple blocks - p
// compare multiple blocks - q

#define LEN 64

byte data_buff[512];
byte data_buff2[512];
unsigned long time_buff[LEN];
unsigned int packets[LEN];
byte t = 0;

void setup() {
  Serial.begin(9600);
  // setup spi
  PORTB |= 0x2c; // all pins high
  DDRB = 0x2c; // sck,mosi,ss all output
  SPCR = 0x53; // master, mode0, ck/64
  SPSR = 0; // clear spi2x
  PORTD |= 1<<PORTD7; // set pd7 high
  DDRD |= 1<<DDD7; // set pd7 output for CS
  //flush buffer
  byte n;
  while (Serial.available() > 0) n = Serial.read();
  // fill data buffer
  for (int i = 0 ; i < 512 ; i++) {
    data_buff[i] = 0xaa;
  }
}

void loop() {
  while (Serial.available() <= 0);
  char j = Serial.read();
  Serial.println(j);
  if (j == 'a') {
    Serial.println("initiate");
    for (byte i = 0 ; i < 12; i++) {
      SPDR = 0xff;
      while(!(SPSR & (1<<SPIF)));
    }
  }
  else if (j == 'b') {
    PORTD &= ~(1<<PORTD7); // cs low
    command_send(0, 0, 0, 0, 0, 0x95);
    byte l = 0;
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
     l = SPDR;
    }
    while (l & 0x80);
    Serial.println(l);
    PORTD |= 1<<PORTD7; // cs high
  }
  else if (j == 'c') {
    PORTD &= ~(1<<PORTD7); // cs low
    command_send(8, 0, 0, 1, 0xaa, 0x87);
    byte l = 0;
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
    }
    while (l & 0x80);
    Serial.println(l);
    for (byte k = 0 ; k < 4 ; k++) {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
      Serial.println(l);
    }
    PORTD |= 1<<PORTD7; // cs high
  }
  else if (j == 'd') {
    PORTD &= ~(1<<PORTD7); // cs low
    command_send(58, 0, 0, 1, 0xaa, 0x87);
    byte l = 0;
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
    }
    while (l & 0x80);
    Serial.println(l);
    for (byte k = 4 ; k > 0 ; k--) {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
      Serial.println(l);
    }
    PORTD |= 1<<PORTD7; // cs high
  }
  else if (j == 'e') Serial.println("test");
  else if (j == 'f') {
    PORTD &= ~(1<<PORTD7); // cs low
    command_send(55, 0, 0, 0, 0, 1);
    byte l = 0;
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
    }
    while (l & 0x80);
    Serial.println(l);
    command_send(41, 0x40, 0, 0, 0, 1); // second variable 0x40 for V2 cards (HC/XC)
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
    }
    while (l & 0x80);
    Serial.println(l);
    PORTD |= 1<<PORTD7; // cs high
  }
  else if (j == 'g') {
    PORTD &= ~(1<<PORTD7); // cs low
    command_send(9, 0, 0, 0, 0, 1);
    byte l = 0;
 //   do {
 //     SPDR = 0x0ff;
 //     while(!(SPSR & (1<<SPIF)));
 //     l = SPDR;
 //   }
 //   while (l & 0x80);
 //   Serial.println(l);
    for (byte i = 100 ; i > 0; i--) {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
      Serial.println(l);
    }
    PORTD |= 1<<PORTD7; // cs high
  }
  else if (j == 'h') {
    SPCR = 0x50; // master, mode0, ck/4
    SPSR = 1; // spi2x on
    unsigned long k = micros();
    PORTD &= ~(1<<PORTD7); // cs low
    command_send(24, 0, 0, 1, 0, 1); // random address
    byte l = 0;
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
    }
    while (l & 0x80);
    unsigned long m = micros();
//    Serial.println(l);
    SPDR = (0xfe); // start byte
    while(!(SPSR & (1<<SPIF)));
    for (int i = 0 ; i < 512 ; i += 2) { // data
      byte j = data_buff[i];
      while(!(SPSR & (1<<SPIF)));
      SPDR = j;
      j = data_buff[i+1];
      while(!(SPSR & (1<<SPIF)));
      SPDR = j;
    }
    while(!(SPSR & (1<<SPIF)));
    SPDR = 0xff;  // dummy CRC
    while(!(SPSR & (1<<SPIF)));
    SPDR = 0xff; // dummy CRC
    while(!(SPSR & (1<<SPIF)));
    SPDR = 0xff; // get next byte
    while(!(SPSR & (1<<SPIF)));
    l = SPDR;
//    Serial.println(l);
    unsigned long n = micros();
    do { // wait for data to get written
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
    }
    while (l != 0xff);
    command_send(13, 0, 0, 0, 0, 1); // get status
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
    }
    while (l & 0x80);
//    Serial.println(l);
    SPDR = 0x0ff;
    while(!(SPSR & (1<<SPIF)));
    l = SPDR;
//    Serial.println(l);
    PORTD |= 1<<PORTD7; // cs high
    unsigned long o = micros();
    Serial.println(m - k);
    Serial.println(n - k);
    Serial.println(o - k);
  }
  else if (j == 'i') {
    SPCR = 0x50; // master, mode0, ck/4
    SPSR = 1; // spi2x on
    unsigned long k = micros();
    PORTD &= ~(1<<PORTD7); // cs low
//    t += 2;
    command_send(17, 0, 4, 0x9a, 0, 1); // random address
    byte l = 0;
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
//      Serial.println(l);
    }
    while (l & 0x80);
    unsigned long m = micros();
//    Serial.println(l);
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
//      Serial.println(l);
    }
    while (l == 0xff);
    unsigned long p = micros();
//    Serial.println(l);
    SPDR = 0xff;
    for (int i = 0 ; i < 512 ; i++) { // data
      while(!(SPSR & (1<<SPIF)));
      SPDR = 0xff;
      data_buff2[i] = SPDR;
    }
    while(!(SPSR & (1<<SPIF)));
    SPDR = 0xff;
    while(!(SPSR & (1<<SPIF)));
    SPDR = 0xff;  // dummy CRC
    while(!(SPSR & (1<<SPIF)));
    do { // wait for line to go high
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
//      Serial.println(l);
    }
    while (l != 0xff);
    PORTD |= 1<<PORTD7; // cs high
//    for (int i = 0 ; i < 512 ; i++) {
//      Serial.write(data_buff2[i]);
//      Serial.println();
//    }
    unsigned long o = micros();
    Serial.println(m - k);
    Serial.println(p - m);
    Serial.println(o - p);
  }
  else if (j == 'k') {
    for (int i = 0 ; i < 512 ; i++) {
      if (data_buff[i] != data_buff2[i]) {
        Serial.println(i);
        Serial.println(data_buff2[i]);
      }
    }
    Serial.println("done");
  }
  else if (j == 'm') {
    for (int i = 0 ; i < 512 ; i++) {
      data_buff[i] = random();
    }
  }
  else if (j == 'n') { // multi-block read
    SPCR = 0x50; // master, mode0, ck/4
    SPSR = 1; // spi2x on
    unsigned long k = micros();
    PORTD &= ~(1<<PORTD7); // cs low
    command_send(18, 0, 1, 0, 0, 1); // random address
    byte l = 0;
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
    }
    while (l & 0x80);
    unsigned long m = micros();
//    Serial.println(l);
//    do {
//      SPDR = 0x0ff;
//      while(!(SPSR & (1<<SPIF)));
//      l = SPDR;
//      Serial.println(l);
//    }
//    while (l != 0xfe);
//    unsigned long p = micros();
//    Serial.println(l);
    for (int j = 0 ; j < LEN ; j++) { // number of bytes to send
      unsigned int r = 0;
      do { // wait for start token
        SPDR = 0x0ff;
        while(!(SPSR & (1<<SPIF)));
        l = SPDR;
        r++;
 //       Serial.println(l);
      }
      while (l != 0xfe);
      packets[j] = r;
      SPDR = 0xff;
      for (int i = 0 ; i < 512 ; i++) { // data
        while(!(SPSR & (1<<SPIF)));
        SPDR = 0xff;
        data_buff2[i] = SPDR;
      }
      while(!(SPSR & (1<<SPIF)));
      SPDR = 0xff;
      while(!(SPSR & (1<<SPIF)));
      SPDR = 0xff;  // dummy CRC
      while(!(SPSR & (1<<SPIF)));
      time_buff[j] = micros();
    }
//    do { // wait for start token
//      SPDR = 0x0ff;
//      while(!(SPSR & (1<<SPIF)));
//      l = SPDR;
 //       Serial.println(l);
//    }
//    while (l != 0xfe);
    unsigned long h = micros();
    command_send(12, 0, 0, 0, 0, 1); // stop transmission
//    do {
//      SPDR = 0x0ff;
//      while(!(SPSR & (1<<SPIF)));
//      l = SPDR;
//      Serial.println(l);
//    }
//    while (l & 0x80);
//    unsigned long h = micros();
//    Serial.println(l);
//    do { // wait for line to go high
//      SPDR = 0x0ff;
//      while(!(SPSR & (1<<SPIF)));
//      l = SPDR;
//      Serial.println(l);
//    }
//    while (l != 0xff);
    for (int i = 0 ; i < 3 ; i++) {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
//      Serial.println(l);
      data_buff[i] = l;
    }
    PORTD |= 1<<PORTD7; // cs high
    unsigned long o = micros();
    Serial.println(m - k);
    Serial.print(time_buff[0] - m);
    Serial.print(";");
    Serial.println(packets[0]);
    for (int i = 1 ; i < LEN ; i++) {
      Serial.print(i);
      Serial.print(";");
      Serial.print(time_buff[i] - time_buff[i - 1]);
      Serial.print(";");
      Serial.println(packets[i]);
    }
    Serial.println(h - time_buff[LEN-1]);
    Serial.println(o - h);
    Serial.println(l);
  }
  else if (j == 'p') {
    SPCR = 0x50; // master, mode0, ck/4
    SPSR = 1; // spi2x on
    byte l = 0;
    unsigned long q = micros();
    PORTD &= ~(1<<PORTD7); // cs low
    command_send(55, 0, 0, 0, 0, 1); // set number of blocks to write
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
    }
    while (l & 0x80);
 //   Serial.println(l);
    command_send(23, 0, 0, 0, LEN, 1);
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
    }
    while (l & 0x80);
 //   Serial.println(l);
 //   for (int i = 0 ; i < 4 ; i++) {
 //     SPDR = 0x0ff;
 //     while(!(SPSR & (1<<SPIF)));
 //     l = SPDR;
 //     Serial.println(l);
 //   }
    command_send(25, 0, 1, 0, 0, 1); // random address
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
    }
    while (l & 0x80);
    unsigned long m = micros();
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
    }
    while (l != 0xff);
//    Serial.println(l);
    for (int k = 0 ; k < LEN ; k++) {
      SPDR = (0xfc); // start byte
      while(!(SPSR & (1<<SPIF)));
      for (int i = 0 ; i < 512 ; i += 2) { // data
        byte j = data_buff[i];
        while(!(SPSR & (1<<SPIF)));
        SPDR = j;
        j = data_buff[i+1];
        while(!(SPSR & (1<<SPIF)));
        SPDR = j;
      }
      while(!(SPSR & (1<<SPIF)));
      SPDR = 0xff;  // dummy CRC
      while(!(SPSR & (1<<SPIF)));
      SPDR = 0xff; // dummy CRC
      while(!(SPSR & (1<<SPIF)));
      SPDR = 0xff; // get next byte
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
      for (int i = 0 ; i < 8 ; i++) { // data
        SPDR = 0xff;
        while(!(SPSR & (1<<SPIF)));
      }
      unsigned int r = 0;
      do { // wait for data to get written
        SPDR = 0x0ff;
        while(!(SPSR & (1<<SPIF)));
        l = SPDR;
        r++;
      }
      while (l == 0x00);
      time_buff[k] = micros();
      packets[k] = r;
    }
    SPDR = 0xfd; // send stop token
    while(!(SPSR & (1<<SPIF)));
    for (int i = 0 ; i < 8 ; i++) { // wait for data line to go low
      SPDR = 0xff;
      while(!(SPSR & (1<<SPIF)));
    }
    do { // wait for line to go back high
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
    }
    while (l != 0xff);
    unsigned long n = micros();
    command_send(55, 0, 0, 0, 0, 1); // get number of well written block
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
    }
    while (l & 0x80);
//    Serial.println(l);
    command_send(22, 0, 0, 0, 0, 1); // get number of well written block
    do {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
    }
    while (l != 0xfe);
    //Serial.println(l);
    for (int i = 0 ; i < 4 ; i++) {
      SPDR = 0x0ff;
      while(!(SPSR & (1<<SPIF)));
      l = SPDR;
 //     Serial.println(l);
    }
    PORTD |= 1<<PORTD7; // cs high
    unsigned long o = micros();
    Serial.println(m - q);
    Serial.println(time_buff[0] - m);
    for (int i = 1 ; i < LEN ; i++) {
      Serial.print(i);
      Serial.print(";");
      Serial.print(time_buff[i] - time_buff[i - 1]);
      Serial.print(";");
      Serial.println(packets[i]);
    }
    Serial.println(n - time_buff[LEN-1]);
    Serial.println(o - n);
    Serial.println(l);
  }
  else if (j == 'q') {
    SPCR = 0x50; // master, mode0, ck/4
    SPSR = 1; // spi2x on
//    unsigned long k = micros();
    for (int a = 0 ; a < LEN ; a++) {
      PORTD &= ~(1<<PORTD7); // cs low
      command_send(17, 0, 1, (a << 1), 0, 1); // random address
      byte l = 0;
      do {
        SPDR = 0x0ff;
        while(!(SPSR & (1<<SPIF)));
        l = SPDR;
//        Serial.println(l);
      }
      while (l & 0x80);
//      Serial.println(l);
      do {
        SPDR = 0x0ff;
        while(!(SPSR & (1<<SPIF)));
        l = SPDR;
//        Serial.println(l);
      }
      while (l == 0xff);
//      Serial.println(l);
      for (int i = 0 ; i < 512 ; i++) { // data
        SPDR = 0xff;
        while(!(SPSR & (1<<SPIF)));
        data_buff2[i] = SPDR;
      }
      SPDR = 0xff; // dummy CRC
      while(!(SPSR & (1<<SPIF)));
      SPDR = 0xff;  // dummy CRC
      while(!(SPSR & (1<<SPIF)));
      do { // wait for line to go high
        SPDR = 0x0ff;
        while(!(SPSR & (1<<SPIF)));
        l = SPDR;
        Serial.println(l);
      }
      while (l != 0xff);
      PORTD |= 1<<PORTD7; // cs high
      for (int i = 0 ; i < 512 ; i++) {
        if (data_buff[i] != data_buff2[i]) {
          Serial.println(i);
          Serial.println(data_buff2[i]);
        }
      }
    Serial.println("done");
    }
  }

}

void command_send(byte a1, byte a2, byte a3, byte a4, byte a5, byte a6) {
  byte l = 0;
//  int k = 0;
  do {
    SPDR = 0xff;
    while(!(SPSR & (1<<SPIF)));
    l = SPDR;
//    k++;
  }
  while (l != 0xff);
//  Serial.println(k);
  SPDR = (0x40 | a1);
  while(!(SPSR & (1<<SPIF)));
  SPDR = a2;
  while(!(SPSR & (1<<SPIF)));
  SPDR = a3;
  while(!(SPSR & (1<<SPIF)));
  SPDR = a4;
  while(!(SPSR & (1<<SPIF)));
  SPDR = a5;
  while(!(SPSR & (1<<SPIF)));
  SPDR = a6;
  while(!(SPSR & (1<<SPIF)));
}