for(int retry=1; retry<20; retry+=2)
      {
          if (count == 1)
          { /* Single block write */
             if ((send_cmd(CMD24, sector) == 0) /* WRITE_BLOCK */
             && xmit_datablock(buff, 0xFE) == RES_OK)
             {
                count = 0;
                break;
             }
          }
          else
          { /* Multiple block write */
             if (disk_type & DISK_TYPE_SDC)
             {
                send_cmd(CMD55, 0);
                send_cmd(CMD23, count); /* ACMD23 */
             }
             if (send_cmd(CMD25, sector) == 0)
             { /* WRITE_MULTIPLE_BLOCK */
                const void* rbuff = buff;
                int rcount = count;
                do
                {
                   if (xmit_datablock(rbuff, 0xFC) != RES_OK)
                      break;
                   rbuff = ((char*)rbuff) + 512;
                } while (--rcount);
                if (xmit_datablock(0, 0xFD) == RES_OK && !rcount) /* STOP_TRAN token */
                {
                   count = 0;
                   break;
                }
             }
          }

          //reset
         if(card_reset(retry))
            retry--;
      }

/**
*
* @param buff      512 byte data block to be transmitted
* @param token      Data/Stop token
* @return
*/
RES_CODE sd_disk_t::xmit_datablock(const void* buff, unsigned int token)
{
   if (!card_ready())
      return RES_ERROR;

   /* Xmit data token */
   hspi.tsk_write_locked(&token, 1);
   if (token != 0xFD)
   { /* Is data token */

      /* Xmit the 512 byte data block to MMC */
      hspi.tsk_write_locked(buff, 512);

      /* CRC (Dummy) */
      token = __REV16(CalculateCRC16CCITT(0, (const char *)buff, 512));
      hspi.tsk_write_locked(&token, 2);
      token = 0;
      hspi.tsk_read_locked(&token, 1);
      if ((token & 0x1F) != 0x05) /* If not accepted, return with error */
      {
         tsk_sleep(100);
         TRACELN("!!!SD xmit -> %02X", token);
         return RES_ERROR;
      }
   }

   return RES_OK;
}