Index: head/stand/mips/beri/common/sdcard.c =================================================================== --- head/stand/mips/beri/common/sdcard.c (revision 327704) +++ head/stand/mips/beri/common/sdcard.c (revision 327705) @@ -1,334 +1,333 @@ /*- * Copyright (c) 2012-2014 Robert N. M. Watson * All rights reserved. * * This software was developed by SRI International and the University of * Cambridge Computer Laboratory under DARPA/AFRL contract (FA8750-10-C-0237) * ("CTSRD"), as part of the DARPA CRASH research programme. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * $FreeBSD$ */ #include #include -#include -#include +#include /* * Altera University Program SD Card micro-driver for boot2 and loader. * * XXXRW: It might be nice to add 'unit' arguments to all APIs to allow * multiple instances to be addressed. */ /* Constants lifted from altera_sdcard.h -- possibly we should share headers? */ #define ALTERA_SDCARD_OFF_RXTX_BUFFER 0 /* 512-byte I/O buffer */ #define ALTERA_SDCARD_OFF_CID 512 /* 16-byte Card ID number */ #define ALTERA_SDCARD_OFF_CSD 528 /* 16-byte Card Specific Data */ #define ALTERA_SDCARD_OFF_OCR 544 /* Operating Conditions Reg */ #define ALTERA_SDCARD_OFF_SR 548 /* SD Card Status Register */ #define ALTERA_SDCARD_OFF_RCA 552 /* Relative Card Address Reg */ #define ALTERA_SDCARD_OFF_CMD_ARG 556 /* Command Argument Register */ #define ALTERA_SDCARD_OFF_CMD 560 /* Command Register */ #define ALTERA_SDCARD_OFF_ASR 564 /* Auxiliary Status Register */ #define ALTERA_SDCARD_OFF_RR1 568 /* Response R1 */ #define ALTERA_SDCARD_SECTORSIZE 512 #define ALTERA_SDCARD_CMD_SEND_RCA 0x03 /* Retrieve card RCA. */ #define ALTERA_SDCARD_CMD_SEND_CSD 0x09 /* Retrieve CSD register. */ #define ALTERA_SDCARD_CMD_SEND_CID 0x0A /* Retrieve CID register. */ #define ALTERA_SDCARD_CMD_READ_BLOCK 0x11 /* Read block from disk. */ #define ALTERA_SDCARD_CMD_WRITE_BLOCK 0x18 /* Write block to disk. */ #define ALTERA_SDCARD_ASR_CMDVALID 0x0001 #define ALTERA_SDCARD_ASR_CARDPRESENT 0x0002 #define ALTERA_SDCARD_ASR_CMDINPROGRESS 0x0004 #define ALTERA_SDCARD_ASR_SRVALID 0x0008 #define ALTERA_SDCARD_ASR_CMDTIMEOUT 0x0010 #define ALTERA_SDCARD_ASR_CMDDATAERROR 0x0020 #define ALTERA_SDCARD_RR1_INITPROCRUNNING 0x0100 #define ALTERA_SDCARD_RR1_ERASEINTERRUPTED 0x0200 #define ALTERA_SDCARD_RR1_ILLEGALCOMMAND 0x0400 #define ALTERA_SDCARD_RR1_COMMANDCRCFAILED 0x0800 #define ALTERA_SDCARD_RR1_ADDRESSMISALIGNED 0x1000 #define ALTERA_SDCARD_RR1_ADDRBLOCKRANGE 0x2000 #define ALTERA_SDCARD_CSD_STRUCTURE_BYTE 15 #define ALTERA_SDCARD_CSD_STRUCTURE_MASK 0xc0 /* 2 bits */ #define ALTERA_SDCARD_CSD_STRUCTURE_RSHIFT 6 #define ALTERA_SDCARD_CSD_SIZE 16 #define ALTERA_SDCARD_CSD_READ_BL_LEN_BYTE 10 #define ALTERA_SDCARD_CSD_READ_BL_LEN_MASK 0x0f /* 4 bits */ #define ALTERA_SDCARD_CSD_C_SIZE_BYTE0 7 #define ALTERA_SDCARD_CSD_C_SIZE_MASK0 0xc0 /* top 2 bits */ #define ALTERA_SDCARD_CSD_C_SIZE_RSHIFT0 6 #define ALTERA_SDCARD_CSD_C_SIZE_BYTE1 8 #define ALTERA_SDCARD_CSD_C_SIZE_MASK1 0xff /* 8 bits */ #define ALTERA_SDCARD_CSD_C_SIZE_LSHIFT1 2 #define ALTERA_SDCARD_CSD_C_SIZE_BYTE2 9 #define ALTERA_SDCARD_CSD_C_SIZE_MASK2 0x03 /* bottom 2 bits */ #define ALTERA_SDCARD_CSD_C_SIZE_LSHIFT2 10 #define ALTERA_SDCARD_CSD_C_SIZE_MULT_BYTE0 5 #define ALTERA_SDCARD_CSD_C_SIZE_MULT_MASK0 0x80 /* top 1 bit */ #define ALTERA_SDCARD_CSD_C_SIZE_MULT_RSHIFT0 7 #define ALTERA_SDCARD_CSD_C_SIZE_MULT_BYTE1 6 #define ALTERA_SDCARD_CSD_C_SIZE_MULT_MASK1 0x03 /* bottom 2 bits */ #define ALTERA_SDCARD_CSD_C_SIZE_MULT_LSHIFT1 1 /* * Not all RR1 values are "errors" per se -- check only for the ones that are * when performing error handling. */ #define ALTERA_SDCARD_RR1_ERRORMASK \ (ALTERA_SDCARD_RR1_ERASEINTERRUPTED | ALTERA_SDCARD_RR1_ILLEGALCOMMAND | \ ALTERA_SDCARD_RR1_COMMANDCRCFAILED | ALTERA_SDCARD_RR1_ADDRESSMISALIGNED |\ ALTERA_SDCARD_RR1_ADDRBLOCKRANGE) extern uint8_t __cheri_sdcard_vaddr__[]; #define ALTERA_SDCARD_PTR(type, offset) \ (volatile type *)(&__cheri_sdcard_vaddr__[(offset)]) static __inline uint16_t altera_sdcard_read_uint16(u_int offset) { volatile uint16_t *p; p = ALTERA_SDCARD_PTR(uint16_t, offset); return (le16toh(*p)); } static __inline void altera_sdcard_write_uint16(u_int offset, uint16_t v) { volatile uint16_t *p; p = ALTERA_SDCARD_PTR(uint16_t, offset); *p = htole16(v); } static __inline void altera_sdcard_write_uint32(u_int offset, uint32_t v) { volatile uint32_t *p; p = ALTERA_SDCARD_PTR(uint32_t, offset); *p = htole32(v); } static __inline uint16_t altera_sdcard_read_asr(void) { return (altera_sdcard_read_uint16(ALTERA_SDCARD_OFF_ASR)); } static __inline uint16_t altera_sdcard_read_rr1(void) { return (altera_sdcard_read_uint16(ALTERA_SDCARD_OFF_RR1)); } static __inline void altera_sdcard_write_cmd(uint16_t cmd) { altera_sdcard_write_uint16(ALTERA_SDCARD_OFF_CMD, cmd); } static __inline void altera_sdcard_write_cmd_arg(uint32_t cmd_arg) { altera_sdcard_write_uint32(ALTERA_SDCARD_OFF_CMD_ARG, cmd_arg); } /* NB: Use 16-bit aligned buffer due to hardware features, so 16-bit type. */ static __inline void altera_sdcard_read_csd(uint16_t *csdp) { volatile uint16_t *hw_csdp; u_int i; hw_csdp = ALTERA_SDCARD_PTR(uint16_t, ALTERA_SDCARD_OFF_CSD); for (i = 0; i < ALTERA_SDCARD_CSD_SIZE / sizeof(uint16_t); i++) csdp[i] = hw_csdp[i]; } /* * Private interface: load exactly one block of size ALTERA_SDCARD_SECTORSIZE * from block #lba. */ static int altera_sdcard_read_block(void *buf, unsigned lba) { volatile uint32_t *rxtxp; uint32_t *bufp; uint16_t asr, rr1; int i; if (!(altera_sdcard_read_asr() & ALTERA_SDCARD_ASR_CARDPRESENT)) { printf("SD Card: card not present\n"); return (-1); } bufp = (uint32_t *)buf; rxtxp = ALTERA_SDCARD_PTR(uint32_t, ALTERA_SDCARD_OFF_RXTX_BUFFER); /* * Issue read block command. */ altera_sdcard_write_cmd_arg(lba * ALTERA_SDCARD_SECTORSIZE); altera_sdcard_write_cmd(ALTERA_SDCARD_CMD_READ_BLOCK); /* * Wait for device to signal completion of command. */ while ((asr = altera_sdcard_read_asr()) & ALTERA_SDCARD_ASR_CMDINPROGRESS); /* * Due to hardware bugs/features, interpretting this field is messy. */ rr1 = altera_sdcard_read_rr1(); rr1 &= ~ALTERA_SDCARD_RR1_COMMANDCRCFAILED; /* HW bug. */ if (asr & ALTERA_SDCARD_ASR_CMDTIMEOUT) { printf("SD Card: timeout\n"); return (-1); } if ((asr & ALTERA_SDCARD_ASR_CMDDATAERROR) && (rr1 & ALTERA_SDCARD_RR1_ERRORMASK)) { printf("SD Card: asr %u rr1 %u\n", asr, rr1); return (-1); } /* * We can't use a regular memcpy() due to byte-enable bugs in the * Altera IP core: instead copy in 32-bit units. */ for (i = 0; i < ALTERA_SDCARD_SECTORSIZE/sizeof(uint32_t); i++) bufp[i] = rxtxp[i]; return (0); } /* * Public interface: load 'nblk' blocks from block #lba into *buf. */ int altera_sdcard_read(void *buf, unsigned lba, unsigned nblk) { uint8_t *bufp = buf; int i; for (i = 0; i < nblk; i++) { if (altera_sdcard_read_block(bufp + i * ALTERA_SDCARD_SECTORSIZE, lba + i) < 0) { printf("SD Card: block read %u failed\n", i); return (-1); } } return (0); } /* * Public interface: query (current) media size. */ uint64_t altera_sdcard_get_mediasize(void) { uint64_t mediasize; uint64_t c_size, c_size_mult, read_bl_len; uint16_t csd16[ALTERA_SDCARD_CSD_SIZE/sizeof(uint16_t)]; uint8_t *csd8p = (uint8_t *)&csd16; uint8_t byte0, byte1, byte2; altera_sdcard_read_csd(csd16); /* Provide 16-bit alignment. */ read_bl_len = csd8p[ALTERA_SDCARD_CSD_READ_BL_LEN_BYTE]; read_bl_len &= ALTERA_SDCARD_CSD_READ_BL_LEN_MASK; byte0 = csd8p[ALTERA_SDCARD_CSD_C_SIZE_BYTE0]; byte0 &= ALTERA_SDCARD_CSD_C_SIZE_MASK0; byte1 = csd8p[ALTERA_SDCARD_CSD_C_SIZE_BYTE1]; byte2 = csd8p[ALTERA_SDCARD_CSD_C_SIZE_BYTE2]; byte2 &= ALTERA_SDCARD_CSD_C_SIZE_MASK2; c_size = (byte0 >> ALTERA_SDCARD_CSD_C_SIZE_RSHIFT0) | (byte1 << ALTERA_SDCARD_CSD_C_SIZE_LSHIFT1) | (byte2 << ALTERA_SDCARD_CSD_C_SIZE_LSHIFT2); byte0 = csd8p[ALTERA_SDCARD_CSD_C_SIZE_MULT_BYTE0]; byte0 &= ALTERA_SDCARD_CSD_C_SIZE_MULT_MASK0; byte1 = csd8p[ALTERA_SDCARD_CSD_C_SIZE_MULT_BYTE1]; byte1 &= ALTERA_SDCARD_CSD_C_SIZE_MULT_MASK1; c_size_mult = (byte0 >> ALTERA_SDCARD_CSD_C_SIZE_MULT_RSHIFT0) | (byte1 << ALTERA_SDCARD_CSD_C_SIZE_MULT_LSHIFT1); mediasize = (c_size + 1) * (1 << (c_size_mult + 2)) * (1 << read_bl_len); return (mediasize); } /* * Public interface: is media present / supported? */ int altera_sdcard_get_present(void) { uint16_t csd16[ALTERA_SDCARD_CSD_SIZE/sizeof(uint16_t)]; uint8_t *csd8p = (uint8_t *)&csd16; uint8_t csd_structure; /* First: does status bit think it is there? */ if (!(altera_sdcard_read_asr() & ALTERA_SDCARD_ASR_CARDPRESENT)) { printf("SD Card: not present\n"); return (0); } /* Second: do we understand the CSD structure version? */ altera_sdcard_read_csd(csd16); /* Provide 16-bit alignment. */ csd_structure = csd8p[ALTERA_SDCARD_CSD_STRUCTURE_BYTE]; csd_structure &= ALTERA_SDCARD_CSD_STRUCTURE_MASK; csd_structure >>= ALTERA_SDCARD_CSD_STRUCTURE_RSHIFT; if (csd_structure != 0) { printf("SD Card: unrecognised csd %u\n", csd_structure); return (0); } return (1); } /* * Public interface: query sector size. */ uint64_t altera_sdcard_get_sectorsize(void) { return (ALTERA_SDCARD_SECTORSIZE); }