Function disk_write

Sming/Libraries/SDCard/SDCard.cpp:481–522

/*-----------------------------------------------------------------------*/

DRESULT disk_write(BYTE drv,		 /* Physical drive nmuber (0) */
				   const BYTE* buff, /* Pointer to the data to be written */
				   DWORD sector,	 /* Start sector number (LBA) */
				   UINT count		 /* Sector count (1..128) */
)
{
	if(disk_status(drv) & STA_NOINIT) {
		return RES_NOTRDY;
	}
	if(!(CardType & CT_BLOCK)) {
		sector *= 512; /* Convert LBA to byte address if needed */
	}

	if(count == 1) {					  /* Single block write */
		if((send_cmd(CMD24, sector) == 0) /* WRITE_BLOCK */
		   && xmit_datablock(buff, 0xFE)) {
			count = 0;
		} else {
			debug_e("[SDCard] CMD24 error");
		}
	} else { /* Multiple block write */
		if(CardType & CT_SDC) {
			send_cmd(ACMD23, count);
		}
		if(send_cmd(CMD25, sector) == 0) { /* WRITE_MULTIPLE_BLOCK */
			do {
				if(!xmit_datablock(buff, 0xFC)) {
					debug_e("[SDCard] xmit error");
					break;
				}
				buff += 512;
			} while(--count);
			if(!xmit_datablock(0, 0xFD)) { /* STOP_TRAN token */
				debug_e("[SDCard] STOP_TRAN error");
				count = 1;
			}
		}
	}
	deselect();

	return count ? RES_ERROR : RES_OK;
}

/*-----------------------------------------------------------------------*/
/* Miscellaneous Functions                                               */