Hardware
/
litex
mirror of https://github.com/enjoy-digital/litex.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

software/liblitesata/sata_init: Switch to SATA Identify to check if disk is responding and add Identify/Capacity decoding. 

With SATA Disk:
litex> sata_init
Initialize SATA...
Model:    KINGSTON SA400S37240G
Capacity: 240GB
Successful.

Without SATA Disk:
litex> sata_init
Initialize SATA... Failed.
This commit is contained in:
Florent Kermarrec 2022-05-18 17:18:51 +02:00
parent 04f6b17d03
commit 1d20bbcd01
3 changed files with 51 additions and 14 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
litex/soc/software/bios/cmds/cmd_litesata.c
View File

@ -20,7 +20,7 @@
static void sata_init_handler(int nb_params, char **params) static void sata_init_handler(int nb_params, char **params)
{ {
printf("Initialize SATA... "); printf("Initialize SATA... ");
if (sata_init()) if (sata_init(1))
printf("Successful.\n"); printf("Successful.\n");
else else
printf("Failed.\n"); printf("Failed.\n");

61
litex/soc/software/liblitesata/sata.c
View File

@ -1,4 +1,4 @@
// This file is Copyright (c) 2020 Florent Kermarrec <florent@enjoy-digital.fr> // This file is Copyright (c) 2020-2022 Florent Kermarrec <florent@enjoy-digital.fr>
// License: BSD // License: BSD
#include <stdio.h> #include <stdio.h>
@ -19,9 +19,14 @@
#ifdef CSR_SATA_PHY_BASE #ifdef CSR_SATA_PHY_BASE
int sata_init(void) { int sata_init(int show) {
uint16_t timeout; uint16_t timeout;
uint8_t buf[512]; int i;
uint32_t data;
uint16_t buf[128];
uint8_t model[38];
uint64_t sectors;
uint32_t capacity;
for (timeout=16; timeout>0; timeout--) { for (timeout=16; timeout>0; timeout--) {
/* Reset SATA PHY */ /* Reset SATA PHY */
@ -37,18 +42,50 @@ int sata_init(void) {
/* Re-initialize if failing */ /* Re-initialize if failing */
continue; continue;
/* Initiate a SATA Read */ /* Initiate a SATA Identify */
sata_sector2mem_base_write((uint64_t)(uintptr_t) buf); sata_identify_start_write(1);
sata_sector2mem_sector_write(0);
sata_sector2mem_start_write(1);
/* Wait for 10ms */ /* Wait for 100ms */
busy_wait(10); busy_wait(100);
/* Check SATA Read status */ /* Check SATA Identify status */
if ((sata_sector2mem_done_read() & 0x1) == 0) if ((sata_identify_done_read() & 0x1) == 0)
/* Re-initialize if failing */
continue; continue;
if (show)
printf("\n");
/* Dump Idenfify response to buf */
i = 0;
while (sata_identify_source_valid_read() && (i < 128)) {
data = sata_identify_source_data_read();
sata_identify_source_ready_write(1);
buf[i+0] = ((data >> 0) & 0xffff);
buf[i+1] = ((data >> 16) & 0xffff);
i += 2;
}
/* Get Disk Model from buf */
i = 0;
memset(model, 0, 38);
for (i=0; i<18; i++) {
model[2*i + 0] = (buf[27+i] >> 8) & 0xff;
model[2*i + 1] = (buf[27+i] >> 0) & 0xff;
}
if (show)
printf("Model: %s\n", model);
/* Get Disk Capacity from buf */
sectors = 0;
sectors += (((uint64_t) buf[100]) << 0);
sectors += (((uint64_t) buf[101]) << 16);
sectors += (((uint64_t) buf[102]) << 32);
sectors += (((uint64_t) buf[103]) << 48);
capacity = sectors/(1000*1000*500/256);
if (show)
printf("Capacity: %ldGB\n", capacity);
/* Init succeeded */ /* Init succeeded */
return 1; return 1;
} }
@ -127,7 +164,7 @@ static DSTATUS sata_disk_status(BYTE drv) {
static DSTATUS sata_disk_initialize(BYTE drv) { static DSTATUS sata_disk_initialize(BYTE drv) {
if (drv) return STA_NOINIT; if (drv) return STA_NOINIT;
if (satastatus) if (satastatus)
satastatus = sata_init() ? 0 : STA_NOINIT; satastatus = sata_init(0) ? 0 : STA_NOINIT;
return satastatus; return satastatus;
} }

2
litex/soc/software/liblitesata/sata.h
View File

@ -12,7 +12,7 @@
#ifdef CSR_SATA_PHY_BASE #ifdef CSR_SATA_PHY_BASE
int sata_init(void); int sata_init(int show);
void fatfs_set_ops_sata(void); void fatfs_set_ops_sata(void);
#endif #endif