andrey/rCore
1
0
Fork 0
mirror of https://github.com/rcore-os/rCore.git synced 2024-11-23 08:26:17 +04:00
Code Issues Projects Releases Wiki Activity

.

Browse Source
This commit is contained in:
BenjaminPMLovegood 2019-05-05 23:49:01 +08:00
parent dc4875c3b3
commit 6520a1e5c7
1 changed files with 30 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

32
kernel/src/arch/aarch64/board/raspi3/emmc.rs
View File

@ -209,6 +209,9 @@ const sd_acommands: [u32; 64] = [
sd_cmd!(RESERVED,63) sd_cmd!(RESERVED,63)
]; ];
const SD_RESET_CMD: u32 = (1 << 25);
const SD_RESET_DAT: u32 = (1 << 26);
const SD_RESET_ALL: u32 = (1 << 24);
#[derive(Debug)] #[derive(Debug)]
pub struct SDScr { pub struct SDScr {
@ -285,6 +288,9 @@ fn usleep(cnt: u32) {
* Other Constants * Other Constants
*/ */
const MAX_WAIT_US: u32 = 1000000;
const MAX_WAIT_TIMES: u32 = MAX_WAIT_US / 1000;
impl EmmcCtl { impl EmmcCtl {
pub fn new() -> EmmcCtl { //TODO: improve it! pub fn new() -> EmmcCtl { //TODO: improve it!
@ -383,11 +389,33 @@ impl EmmcCtl {
} }
pub fn sd_reset_cmd(&mut self) -> bool { pub fn sd_reset_cmd(&mut self) -> bool {
false let mut control1 = self.emmc.registers.CONTROL1.read();
self.emmc.registers.CONTROL1.write(control1 | SD_RESET_CMD);
let mut succeeded = false;
for _ in 0..MAX_WAIT_TIMES {
if self.emmc.registers.CONTROL1.read() & SD_RESET_CMD == 0 {
succeeded = true;
break;
}
}
succeeded
} }
pub fn sd_reset_dat(&mut self) -> bool { pub fn sd_reset_dat(&mut self) -> bool {
false let mut control1 = self.emmc.registers.CONTROL1.read();
self.emmc.registers.CONTROL1.write(control1 | SD_RESET_DAT);
let mut succeeded = false;
for _ in 0..MAX_WAIT_TIMES {
if self.emmc.registers.CONTROL1.read() & SD_RESET_DAT == 0 {
succeeded = true;
break;
}
}
succeeded
} }
pub fn sd_issue_command_int(&mut self, cmd_reg: u32, argument: u32, timeout: u32) { pub fn sd_issue_command_int(&mut self, cmd_reg: u32, argument: u32, timeout: u32) {