From 6c7bdd85bbe8d2b791e0fe52f93f5e75e8beea2d Mon Sep 17 00:00:00 2001 From: Christian Cunningham Date: Sun, 20 Feb 2022 23:49:03 -0700 Subject: SD Stuff coming soon --- .gitignore | 1 + Common.mk | 15 ++- README.md | 3 +- include/symbols.h | 29 +++-- later/sd.c | 336 +++++++++++++++++++++++++++++++++++++++++++++++++++++ later/sd.h | 11 ++ src/drivers/uart.c | 6 +- 7 files changed, 386 insertions(+), 15 deletions(-) create mode 100644 later/sd.c create mode 100644 later/sd.h diff --git a/.gitignore b/.gitignore index d80a0d9..395c0bf 100644 --- a/.gitignore +++ b/.gitignore @@ -4,3 +4,4 @@ mk.old Makefile serial.log *.swp +*.hda diff --git a/Common.mk b/Common.mk index 450e870..dba0faa 100644 --- a/Common.mk +++ b/Common.mk @@ -19,6 +19,9 @@ QFLAGS = -M raspi2b -cpu cortex-a7 -m 1G QFLAGS += -chardev stdio,id=char0,mux=on,logfile=serial.log,signal=off -serial chardev:char0 -mon chardev=char0 #QFLAGS += -serial pipe:/tmp/guest QFLAGS += -device usb-kbd +ifneq ("$(wildcard ./sd.hda)","") + QFLAGS += -drive file=sd.hda,if=sd,format=raw +endif #QFLAGS += -trace events=events #QFLAGS += -nographic @@ -31,7 +34,7 @@ endif CFLAGS += -DVERSION="\"0.1b\"" -.PHONY: clean run run-debug debug export tree +.PHONY: clean run run-debug debug export tree disk default: clean build/kernel7.img @@ -52,8 +55,8 @@ build/kernel.elf: ${A_OBJECTD} ${C_OBJECTD} @mkdir -p $(@D) ${CC} -T linker.ld -o $@ -ffreestanding -O3 -nostdlib $^ -export: build/kernel.list - cp build/kernel-g.elf /mnt/c/Local/ +export: build/kernel.elf sd.hda + cp $^ /mnt/c/temp/ obj/%.co: src/%.c @mkdir -p $(@D) @@ -74,6 +77,12 @@ run-debug: build/kernel-g.elf debug: build/kernel-g.elf build/kernel.list ${GDB} $< -command=gdbinit +sd.hda: + cp README.md sd.hda + dd if=/dev/zero of=sd.hda count=1 bs=1 seek=16383 + +disk: sd.hda + clean: rm -rf obj/* build/* diff --git a/README.md b/README.md index 4417996..785851e 100644 --- a/README.md +++ b/README.md @@ -19,8 +19,7 @@ ## Todo - Implement Lock for accessing thread information - - Fix mutex with scheduler - - Implement handlers + - SD Reading ## SVC Calls - Sysinfo diff --git a/include/symbols.h b/include/symbols.h index 04d1d1b..90cfcf0 100644 --- a/include/symbols.h +++ b/include/symbols.h @@ -13,13 +13,7 @@ enum // The offsets for reach register. GPIO_BASE = (MMIO_BASE + 0x200000), - // Controls actuation of pull up/down to ALL GPIO pins. - GPPUD = (GPIO_BASE + 0x94), - - // Controls actuation of pull up/down for specific GPIO pin. - GPPUDCLK0 = (GPIO_BASE + 0x98), - - // The base address for UART. + //// The base address for UART. UART0_BASE = (GPIO_BASE + 0x1000), // for raspi4 0xFE201000, raspi2 & 3 0x3F201000, and 0x20201000 for raspi1 // The offsets for reach register for the UART. @@ -110,4 +104,25 @@ enum SYS_TIMER_SC_M3 = (1 << 3), }; +#define GPFSEL0 ((volatile unsigned int*)(MMIO_BASE+0x00200000)) +#define GPFSEL1 ((volatile unsigned int*)(MMIO_BASE+0x00200004)) +#define GPFSEL2 ((volatile unsigned int*)(MMIO_BASE+0x00200008)) +#define GPFSEL3 ((volatile unsigned int*)(MMIO_BASE+0x0020000C)) +#define GPFSEL4 ((volatile unsigned int*)(MMIO_BASE+0x00200010)) +#define GPFSEL5 ((volatile unsigned int*)(MMIO_BASE+0x00200014)) +#define GPSET0 ((volatile unsigned int*)(MMIO_BASE+0x0020001C)) +#define GPSET1 ((volatile unsigned int*)(MMIO_BASE+0x00200020)) +#define GPCLR0 ((volatile unsigned int*)(MMIO_BASE+0x00200028)) +#define GPLEV0 ((volatile unsigned int*)(MMIO_BASE+0x00200034)) +#define GPLEV1 ((volatile unsigned int*)(MMIO_BASE+0x00200038)) +#define GPEDS0 ((volatile unsigned int*)(MMIO_BASE+0x00200040)) +#define GPEDS1 ((volatile unsigned int*)(MMIO_BASE+0x00200044)) +#define GPHEN0 ((volatile unsigned int*)(MMIO_BASE+0x00200064)) +#define GPHEN1 ((volatile unsigned int*)(MMIO_BASE+0x00200068)) +// Controls actuation of pull up/down to ALL GPIO pins. +#define GPPUD ((volatile unsigned int*)(MMIO_BASE+0x00200094)) +//// Controls actuation of pull up/down for specific GPIO pin. +#define GPPUDCLK0 ((volatile unsigned int*)(MMIO_BASE+0x00200098)) +#define GPPUDCLK1 ((volatile unsigned int*)(MMIO_BASE+0x0020009C)) + #endif diff --git a/later/sd.c b/later/sd.c new file mode 100644 index 0000000..ec07699 --- /dev/null +++ b/later/sd.c @@ -0,0 +1,336 @@ +#include +#include +#include +#include + +#define EMMC_ARG2 ((volatile unsigned int*)(MMIO_BASE+0x00300000)) +#define EMMC_BLKSIZECNT ((volatile unsigned int*)(MMIO_BASE+0x00300004)) +#define EMMC_ARG1 ((volatile unsigned int*)(MMIO_BASE+0x00300008)) +#define EMMC_CMDTM ((volatile unsigned int*)(MMIO_BASE+0x0030000C)) +#define EMMC_RESP0 ((volatile unsigned int*)(MMIO_BASE+0x00300010)) +#define EMMC_RESP1 ((volatile unsigned int*)(MMIO_BASE+0x00300014)) +#define EMMC_RESP2 ((volatile unsigned int*)(MMIO_BASE+0x00300018)) +#define EMMC_RESP3 ((volatile unsigned int*)(MMIO_BASE+0x0030001C)) +#define EMMC_DATA ((volatile unsigned int*)(MMIO_BASE+0x00300020)) +#define EMMC_STATUS ((volatile unsigned int*)(MMIO_BASE+0x00300024)) +#define EMMC_CONTROL0 ((volatile unsigned int*)(MMIO_BASE+0x00300028)) +#define EMMC_CONTROL1 ((volatile unsigned int*)(MMIO_BASE+0x0030002C)) +#define EMMC_INTERRUPT ((volatile unsigned int*)(MMIO_BASE+0x00300030)) +#define EMMC_INT_MASK ((volatile unsigned int*)(MMIO_BASE+0x00300034)) +#define EMMC_INT_EN ((volatile unsigned int*)(MMIO_BASE+0x00300038)) +#define EMMC_CONTROL2 ((volatile unsigned int*)(MMIO_BASE+0x0030003C)) +#define EMMC_SLOTISR_VER ((volatile unsigned int*)(MMIO_BASE+0x003000FC)) + +// command flags +#define CMD_NEED_APP 0x80000000 +#define CMD_RSPNS_48 0x00020000 +#define CMD_ERRORS_MASK 0xfff9c004 +#define CMD_RCA_MASK 0xffff0000 + +// COMMANDs +#define CMD_GO_IDLE 0x00000000 +#define CMD_ALL_SEND_CID 0x02010000 +#define CMD_SEND_REL_ADDR 0x03020000 +#define CMD_CARD_SELECT 0x07030000 +#define CMD_SEND_IF_COND 0x08020000 +#define CMD_STOP_TRANS 0x0C030000 +#define CMD_READ_SINGLE 0x11220010 +#define CMD_READ_MULTI 0x12220032 +#define CMD_SET_BLOCKCNT 0x17020000 +#define CMD_APP_CMD 0x37000000 +#define CMD_SET_BUS_WIDTH (0x06020000|CMD_NEED_APP) +#define CMD_SEND_OP_COND (0x29020000|CMD_NEED_APP) +#define CMD_SEND_SCR (0x33220010|CMD_NEED_APP) + +// STATUS register settings +#define SR_READ_AVAILABLE 0x00000800 +#define SR_DAT_INHIBIT 0x00000002 +#define SR_CMD_INHIBIT 0x00000001 +#define SR_APP_CMD 0x00000020 + +// INTERRUPT register settings +#define INT_DATA_TIMEOUT 0x00100000 +#define INT_CMD_TIMEOUT 0x00010000 +#define INT_READ_RDY 0x00000020 +#define INT_CMD_DONE 0x00000001 + +#define INT_ERROR_MASK 0x017E8000 + +// CONTROL register settings +#define C0_SPI_MODE_EN 0x00100000 +#define C0_HCTL_HS_EN 0x00000004 +#define C0_HCTL_DWITDH 0x00000002 + +#define C1_SRST_DATA 0x04000000 +#define C1_SRST_CMD 0x02000000 +#define C1_SRST_HC 0x01000000 +#define C1_TOUNIT_DIS 0x000f0000 +#define C1_TOUNIT_MAX 0x000e0000 +#define C1_CLK_GENSEL 0x00000020 +#define C1_CLK_EN 0x00000004 +#define C1_CLK_STABLE 0x00000002 +#define C1_CLK_INTLEN 0x00000001 + +// SLOTISR_VER values +#define HOST_SPEC_NUM 0x00ff0000 +#define HOST_SPEC_NUM_SHIFT 16 +#define HOST_SPEC_V3 2 +#define HOST_SPEC_V2 1 +#define HOST_SPEC_V1 0 + +// SCR flags +#define SCR_SD_BUS_WIDTH_4 0x00000400 +#define SCR_SUPP_SET_BLKCNT 0x02000000 +// added by my driver +#define SCR_SUPP_CCS 0x00000001 + +#define ACMD41_VOLTAGE 0x00ff8000 +#define ACMD41_CMD_COMPLETE 0x80000000 +#define ACMD41_CMD_CCS 0x40000000 +#define ACMD41_ARG_HC 0x51ff8000 + +unsigned long sd_scr[2], sd_ocr, sd_rca, sd_err, sd_hv; + +void wait_msec(unsigned int n) +{ + for(unsigned long i = 0; i < n*100; i++) + asm volatile("nop"); +} + +/** + * Wait for data or command ready + */ +int sd_status(unsigned int mask) +{ + int cnt = 500000; while((*EMMC_STATUS & mask) && !(*EMMC_INTERRUPT & INT_ERROR_MASK) && cnt--) wait_msec(1); + return (cnt <= 0 || (*EMMC_INTERRUPT & INT_ERROR_MASK)) ? SD_ERROR : SD_OK; +} + +/** + * Wait for interrupt + */ +int sd_int(unsigned int mask) +{ + unsigned int r, m=mask | INT_ERROR_MASK; + int cnt = 1000000; while(!(*EMMC_INTERRUPT & m) && cnt--) wait_msec(1); + r=*EMMC_INTERRUPT; + if(cnt<=0 || (r & INT_CMD_TIMEOUT) || (r & INT_DATA_TIMEOUT) ) { *EMMC_INTERRUPT=r; return SD_TIMEOUT; } else + if(r & INT_ERROR_MASK) { *EMMC_INTERRUPT=r; return SD_ERROR; } + *EMMC_INTERRUPT=mask; + return 0; +} + +/** + * Send a command + */ +unsigned int sd_cmd(unsigned int code, unsigned int arg) +{ + unsigned int r=0; + sd_err=SD_OK; + if(code&CMD_NEED_APP) { + r=sd_cmd(CMD_APP_CMD|(sd_rca?CMD_RSPNS_48:0),sd_rca); + if(sd_rca && !r) { uart_string("ERROR: failed to send SD APP command\n"); sd_err=SD_ERROR;return 0;} + code &= ~CMD_NEED_APP; + } + if(sd_status(SR_CMD_INHIBIT)) { uart_string("ERROR: EMMC busy\n"); sd_err= SD_TIMEOUT;return 0;} + uart_string("EMMC: Sending command ");uart_hex(code);uart_string(" arg ");uart_hex(arg);uart_string("\n"); + *EMMC_INTERRUPT=*EMMC_INTERRUPT; *EMMC_ARG1=arg; *EMMC_CMDTM=code; + if(code==CMD_SEND_OP_COND) wait_msec(1000); else + if(code==CMD_SEND_IF_COND || code==CMD_APP_CMD) wait_msec(100); + if((r=sd_int(INT_CMD_DONE))) {uart_string("ERROR: failed to send EMMC command\n");sd_err=r;return 0;} + r=*EMMC_RESP0; + if(code==CMD_GO_IDLE || code==CMD_APP_CMD) return 0; else + if(code==(CMD_APP_CMD|CMD_RSPNS_48)) return r&SR_APP_CMD; else + if(code==CMD_SEND_OP_COND) return r; else + if(code==CMD_SEND_IF_COND) return r==arg? SD_OK : SD_ERROR; else + if(code==CMD_ALL_SEND_CID) {r|=*EMMC_RESP3; r|=*EMMC_RESP2; r|=*EMMC_RESP1; return r; } else + if(code==CMD_SEND_REL_ADDR) { + sd_err=(((r&0x1fff))|((r&0x2000)<<6)|((r&0x4000)<<8)|((r&0x8000)<<8))&CMD_ERRORS_MASK; + return r&CMD_RCA_MASK; + } + return r&CMD_ERRORS_MASK; + // make gcc happy + return 0; +} + +/** + * read a block from sd card and return the number of bytes read + * returns 0 on error. + */ +int sd_readblock(unsigned int lba, unsigned char *buffer, unsigned int num) +{ + unsigned int r,c=0,d; + if(num<1) num=1; + uart_string("sd_readblock lba ");uart_hex(lba);uart_string(" num ");uart_hex(num);uart_string("\n"); + if(sd_status(SR_DAT_INHIBIT)) {sd_err=SD_TIMEOUT; return 0;} + unsigned int *buf=(unsigned int *)buffer; + if(sd_scr[0] & SCR_SUPP_CCS) { + if(num > 1 && (sd_scr[0] & SCR_SUPP_SET_BLKCNT)) { + sd_cmd(CMD_SET_BLOCKCNT,num); + if(sd_err) return 0; + } + *EMMC_BLKSIZECNT = (num << 16) | 512; + sd_cmd(num == 1 ? CMD_READ_SINGLE : CMD_READ_MULTI,lba); + if(sd_err) return 0; + } else { + *EMMC_BLKSIZECNT = (1 << 16) | 512; + } + while( c < num ) { + if(!(sd_scr[0] & SCR_SUPP_CCS)) { + sd_cmd(CMD_READ_SINGLE,(lba+c)*512); + if(sd_err) return 0; + } + if((r=sd_int(INT_READ_RDY))){uart_string("\rERROR: Timeout waiting for ready to read\n");sd_err=r;return 0;} + for(d=0;d<128;d++) buf[d] = *EMMC_DATA; + c++; buf+=128; + } + if( num > 1 && !(sd_scr[0] & SCR_SUPP_SET_BLKCNT) && (sd_scr[0] & SCR_SUPP_CCS)) sd_cmd(CMD_STOP_TRANS,0); + return sd_err!=SD_OK || c!=num? 0 : num*512; +} + +/** + * set SD clock to frequency in Hz + */ +int sd_clk(unsigned int f) +{ + unsigned int d,c=41666666/f,x,s=32,h=0; + int cnt = 100000; + while((*EMMC_STATUS & (SR_CMD_INHIBIT|SR_DAT_INHIBIT)) && cnt--) wait_msec(1); + if(cnt<=0) { + uart_string("ERROR: timeout waiting for inhibit flag\n"); + return SD_ERROR; + } + + *EMMC_CONTROL1 &= ~C1_CLK_EN; wait_msec(10); + x=c-1; if(!x) s=0; else { + if(!(x & 0xffff0000u)) { x <<= 16; s -= 16; } + if(!(x & 0xff000000u)) { x <<= 8; s -= 8; } + if(!(x & 0xf0000000u)) { x <<= 4; s -= 4; } + if(!(x & 0xc0000000u)) { x <<= 2; s -= 2; } + if(!(x & 0x80000000u)) { x <<= 1; s -= 1; } + if(s>0) s--; + if(s>7) s=7; + } + if(sd_hv>HOST_SPEC_V2) d=c; else d=(1<HOST_SPEC_V2) h=(d&0x300)>>2; + d=(((d&0x0ff)<<8)|h); + *EMMC_CONTROL1=(*EMMC_CONTROL1&0xffff003f)|d; wait_msec(10); + *EMMC_CONTROL1 |= C1_CLK_EN; wait_msec(10); + cnt=10000; while(!(*EMMC_CONTROL1 & C1_CLK_STABLE) && cnt--) wait_msec(10); + if(cnt<=0) { + uart_string("ERROR: failed to get stable clock\n"); + return SD_ERROR; + } + return SD_OK; +} + +/** + * initialize EMMC to read SDHC card + */ +int sd_init() +{ + long r,cnt,ccs=0; + // GPIO_CD + r=*GPFSEL4; r&=~(7<<(7*3)); *GPFSEL4=r; + *(volatile unsigned int*)GPPUD=2; delay(150); *GPPUDCLK1=(1<<15); delay(150); *(volatile unsigned int*)GPPUD=0; *GPPUDCLK1=0; + r=*GPHEN1; r|=1<<15; *GPHEN1=r; + + // GPIO_CLK, GPIO_CMD + r=*GPFSEL4; r|=(7<<(8*3))|(7<<(9*3)); *GPFSEL4=r; + *(volatile unsigned int*)GPPUD=2; delay(150); *GPPUDCLK1=(1<<16)|(1<<17); delay(150); *(volatile unsigned int*)GPPUD=0; *GPPUDCLK1=0; + + // GPIO_DAT0, GPIO_DAT1, GPIO_DAT2, GPIO_DAT3 + r=*GPFSEL5; r|=(7<<(0*3)) | (7<<(1*3)) | (7<<(2*3)) | (7<<(3*3)); *GPFSEL5=r; + *(volatile unsigned int*)GPPUD=2; delay(150); + *GPPUDCLK1=(1<<18) | (1<<19) | (1<<20) | (1<<21); + delay(150); *(volatile unsigned int*)GPPUD=0; *GPPUDCLK1=0; + + sd_hv = (*EMMC_SLOTISR_VER & HOST_SPEC_NUM) >> HOST_SPEC_NUM_SHIFT; + uart_string("EMMC: GPIO set up\n"); + // Reset the card. + *EMMC_CONTROL0 = 0; *EMMC_CONTROL1 |= C1_SRST_HC; + cnt=10000; do{wait_msec(10);} while( (*EMMC_CONTROL1 & C1_SRST_HC) && cnt-- ); + if(cnt<=0) { + uart_string("ERROR: failed to reset EMMC\n"); + return SD_ERROR; + } + uart_string("EMMC: reset OK\n"); + *EMMC_CONTROL1 |= C1_CLK_INTLEN | C1_TOUNIT_MAX; + wait_msec(10); + // Set clock to setup frequency. + if((r=sd_clk(400000))) return r; + *EMMC_INT_EN = 0xffffffff; + *EMMC_INT_MASK = 0xffffffff; + sd_scr[0]=sd_scr[1]=sd_rca=sd_err=0; + sd_cmd(CMD_GO_IDLE,0); + if(sd_err) return sd_err; + + sd_cmd(CMD_SEND_IF_COND,0x000001AA); + if(sd_err) return sd_err; + cnt=6; r=0; while(!(r&ACMD41_CMD_COMPLETE) && cnt--) { + delay(400); + r=sd_cmd(CMD_SEND_OP_COND,ACMD41_ARG_HC); + uart_string("EMMC: CMD_SEND_OP_COND returned "); + if(r&ACMD41_CMD_COMPLETE) + uart_string("COMPLETE "); + if(r&ACMD41_VOLTAGE) + uart_string("VOLTAGE "); + if(r&ACMD41_CMD_CCS) + uart_string("CCS "); + //uart_hex(r>>32); + uart_hex(r); + uart_string("\n"); + if(sd_err!=SD_TIMEOUT && sd_err!=SD_OK ) { + uart_string("ERROR: EMMC ACMD41 returned error\n"); + return sd_err; + } + } + if(!(r&ACMD41_CMD_COMPLETE) || !cnt ) return SD_TIMEOUT; + if(!(r&ACMD41_VOLTAGE)) return SD_ERROR; + if(r&ACMD41_CMD_CCS) ccs=SCR_SUPP_CCS; + + sd_cmd(CMD_ALL_SEND_CID,0); + + sd_rca = sd_cmd(CMD_SEND_REL_ADDR,0); + uart_string("EMMC: CMD_SEND_REL_ADDR returned "); + //uart_hex(sd_rca>>32); + uart_hex(sd_rca); + uart_string("\n"); + if(sd_err) return sd_err; + + if((r=sd_clk(25000000))) return r; + + sd_cmd(CMD_CARD_SELECT,sd_rca); + if(sd_err) return sd_err; + + if(sd_status(SR_DAT_INHIBIT)) return SD_TIMEOUT; + *EMMC_BLKSIZECNT = (1<<16) | 8; + sd_cmd(CMD_SEND_SCR,0); + if(sd_err) return sd_err; + if(sd_int(INT_READ_RDY)) return SD_TIMEOUT; + + r=0; cnt=100000; while(r<2 && cnt) { + if( *EMMC_STATUS & SR_READ_AVAILABLE ) + sd_scr[r++] = *EMMC_DATA; + else + wait_msec(1); + } + if(r!=2) return SD_TIMEOUT; + if(sd_scr[0] & SCR_SD_BUS_WIDTH_4) { + sd_cmd(CMD_SET_BUS_WIDTH,sd_rca|2); + if(sd_err) return sd_err; + *EMMC_CONTROL0 |= C0_HCTL_DWITDH; + } + // add software flag + uart_string("EMMC: supports "); + if(sd_scr[0] & SCR_SUPP_SET_BLKCNT) + uart_string("SET_BLKCNT "); + if(ccs) + uart_string("CCS "); + uart_string("\n"); + sd_scr[0]&=~SCR_SUPP_CCS; + sd_scr[0]|=ccs; + return SD_OK; +} diff --git a/later/sd.h b/later/sd.h new file mode 100644 index 0000000..30d973b --- /dev/null +++ b/later/sd.h @@ -0,0 +1,11 @@ +#ifndef DRIVERS_SD_H +#define DRIVERS_SD_H + +#define SD_OK 0 +#define SD_TIMEOUT (unsigned long)-1 +#define SD_ERROR (unsigned long)-2 + +int sd_init(); +int sd_readblock(unsigned int lba, unsigned char *buffer, unsigned int num); + +#endif diff --git a/src/drivers/uart.c b/src/drivers/uart.c index d6bb92b..becda2d 100644 --- a/src/drivers/uart.c +++ b/src/drivers/uart.c @@ -20,11 +20,11 @@ void uart_init(void) // Disable UART0 store32(0x0, UART0_CR); // Setup GPIO on pin 14 and 15 - store32(0x0, GPPUD); + store32(0x0, (unsigned long)GPPUD); delay(150); - store32((1 << 14) | (1 << 15), GPPUDCLK0); + store32((1 << 14) | (1 << 15), (unsigned long)GPPUDCLK0); delay(150); - store32(0x0, GPPUDCLK0); + store32(0x0, (unsigned long)GPPUDCLK0); // Clear pending interrupts store32(0x7FF, UART0_ICR); // Set to 3Mhz -- cgit v1.2.1