1654efc313
* Editing a bunch of drivers' thread routines in order to implement a new feature is tedious. * No matter the number of storage drivers, they share one thread. No extra threads needed for CONFIG_STORAGE_MULTI. * Each has an event callback called by the storage thread. * A default callback is provided to fake sleeping in order to trigger idle callbacks. It could also do other default processing. Changes to it will be part of driver code without editing each one. * Drivers may sleep and wake as they please as long as they give a low pulse on their storage bit to ask to go into sleep mode. Idle callback is called on its behalf and driver immediately put into sleep mode. * Drivers may indicate they are to continue receiving events in USB mode, otherwise they receve nothing until disconnect (they do receive SYS_USB_DISCONNECTED no matter what). * Rework a few things to keep the callback implementation sane and maintainable. ata.c was dreadful with all those bools; make it a state machine and easier to follow. Remove last_user_activity; it has no purpose that isn't served by keeping the disk active through last_disk_activity instead. * Even-out stack sizes partly because of a lack of a decent place to define them by driver or SoC or whatever; it doesn't seem too critical to do that anyway. Many are simply too large while at least one isn't really adequate. They may be individually overridden if necessary (figure out where). The thread uses the greatest size demanded. Newer file code is much more frugal with stack space. I barely see use crack 50% after idle callbacks (usually mid-40s). Card insert/eject doesn't demand much. * No forcing of idle callbacks. If it isn't necessary for one or more non-disk storage types, it really isn't any more necessary for disk storage. Besides, it makes the whole thing easier to implement. Change-Id: Id30c284d82a8af66e47f2cfe104c52cbd8aa7215
823 lines
19 KiB
C
823 lines
19 KiB
C
/***************************************************************************
|
|
* __________ __ ___.
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
* \/ \/ \/ \/ \/
|
|
* $Id$
|
|
*
|
|
* Copyright (C) 2008 by Frank Gevaerts
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version 2
|
|
* of the License, or (at your option) any later version.
|
|
*
|
|
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
|
* KIND, either express or implied.
|
|
*
|
|
****************************************************************************/
|
|
#include "storage.h"
|
|
#include "kernel.h"
|
|
#include "ata_idle_notify.h"
|
|
#include "usb.h"
|
|
#include "disk.h"
|
|
|
|
#ifdef CONFIG_STORAGE_MULTI
|
|
|
|
#define DRIVER_MASK 0xff000000
|
|
#define DRIVER_OFFSET 24
|
|
#define DRIVE_MASK 0x00ff0000
|
|
#define DRIVE_OFFSET 16
|
|
#define PARTITION_MASK 0x0000ff00
|
|
|
|
static unsigned int storage_drivers[NUM_DRIVES];
|
|
static unsigned int num_drives;
|
|
#endif /* CONFIG_STORAGE_MULTI */
|
|
|
|
/* defaults: override elsewhere target-wise if they must be different */
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
#ifndef ATA_THREAD_STACK_SIZE
|
|
#define ATA_THREAD_STACK_SIZE (DEFAULT_STACK_SIZE*2)
|
|
#endif
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
#ifndef MMC_THREAD_STACK_SIZE
|
|
#define MMC_THREAD_STACK_SIZE (DEFAULT_STACK_SIZE*2)
|
|
#endif
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
#ifndef SD_THREAD_STACK_SIZE
|
|
#define SD_THREAD_STACK_SIZE (DEFAULT_STACK_SIZE*2)
|
|
#endif
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
#ifndef NAND_THREAD_STACK_SIZE
|
|
#define NAND_THREAD_STACK_SIZE (DEFAULT_STACK_SIZE*2)
|
|
#endif
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
#ifndef RAMDISK_THREAD_STACK_SIZE
|
|
#define RAMDISK_THREAD_STACK_SIZE (0) /* not used on its own */
|
|
#endif
|
|
#endif
|
|
|
|
static struct event_queue storage_queue SHAREDBSS_ATTR;
|
|
static unsigned int storage_thread_id = 0;
|
|
|
|
static union {
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
long stk_ata[ATA_THREAD_STACK_SIZE / sizeof (long)];
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
long stk_mmc[MMC_THREAD_STACK_SIZE / sizeof (long)];
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
long stk_sd[SD_THREAD_STACK_SIZE / sizeof (long)];
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
long stk_nand[NAND_THREAD_STACK_SIZE / sizeof (long)];
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
long stk_ramdisk[RAMDISK_THREAD_STACK_SIZE / sizeof (long)];
|
|
#endif
|
|
} storage_thread_stack;
|
|
|
|
static const char storage_thread_name[] =
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
"/ata"
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
"/mmc"
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
"/sd"
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
"/nand"
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
"/ramdisk"
|
|
#endif
|
|
;
|
|
|
|
/* event is targeted to a specific drive */
|
|
#define DRIVE_EVT (1 << STORAGE_NUM_TYPES)
|
|
|
|
#ifdef CONFIG_STORAGE_MULTI
|
|
static int storage_event_send(unsigned int route, long id, intptr_t data)
|
|
{
|
|
/* most events go to everyone */
|
|
if (UNLIKELY(route == DRIVE_EVT)) {
|
|
route = (storage_drivers[data] & DRIVER_MASK) >> DRIVER_OFFSET;
|
|
data = (storage_drivers[data] & DRIVE_MASK) >> DRIVE_OFFSET;
|
|
}
|
|
|
|
int rc = 0;
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
if (route & STORAGE_ATA) {
|
|
rc = ata_event(id, data);
|
|
}
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
if (route & STORAGE_MMC) {
|
|
rc = mmc_event(id, data);
|
|
}
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
if (route & STORAGE_SD) {
|
|
rc = sd_event(id, data);
|
|
}
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
if (route & STORAGE_NAND) {
|
|
rc = nand_event(id, data);
|
|
}
|
|
#endif
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
if (route & STORAGE_RAMDISK) {
|
|
rc = ramdisk_event(id, data);
|
|
}
|
|
#endif
|
|
|
|
return rc;
|
|
}
|
|
#endif /* CONFIG_STORAGE_MULTI */
|
|
|
|
#ifndef CONFIG_STORAGE_MULTI
|
|
static FORCE_INLINE int storage_event_send(unsigned int route, long id,
|
|
intptr_t data)
|
|
{
|
|
return route ? STORAGE_FUNCTION(event)(id, data) : 0;
|
|
}
|
|
#endif /* ndef CONFIG_STORAGE_MULTI */
|
|
|
|
static void NORETURN_ATTR storage_thread(void)
|
|
{
|
|
unsigned int bdcast = CONFIG_STORAGE;
|
|
bool usb_mode = false;
|
|
struct queue_event ev;
|
|
|
|
while (1)
|
|
{
|
|
queue_wait_w_tmo(&storage_queue, &ev, HZ/2);
|
|
|
|
switch (ev.id)
|
|
{
|
|
case SYS_TIMEOUT:;
|
|
/* drivers hold their bit low when they want to
|
|
sleep and keep it high otherwise */
|
|
unsigned int trig = 0;
|
|
storage_event_send(bdcast, Q_STORAGE_TICK, (intptr_t)&trig);
|
|
trig = bdcast & ~trig;
|
|
if (trig) {
|
|
if (!usb_mode) {
|
|
call_storage_idle_notifys(false);
|
|
}
|
|
storage_event_send(trig, Q_STORAGE_SLEEPNOW, 0);
|
|
}
|
|
break;
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
case Q_STORAGE_SLEEP:
|
|
storage_event_send(bdcast, ev.id, 0);
|
|
break;
|
|
#endif
|
|
|
|
#ifdef STORAGE_CLOSE
|
|
case Q_STORAGE_CLOSE:
|
|
storage_event_send(CONFIG_STORAGE, ev.id, 0);
|
|
thread_exit();
|
|
#endif /* STORAGE_CLOSE */
|
|
|
|
#ifdef HAVE_HOTSWAP
|
|
case SYS_HOTSWAP_INSERTED:
|
|
case SYS_HOTSWAP_EXTRACTED:
|
|
if (!usb_mode) {
|
|
int drive = IF_MD_DRV(ev.data);
|
|
if (!CHECK_DRV(drive)) {
|
|
break;
|
|
}
|
|
|
|
int umnt = disk_unmount(drive);
|
|
int mnt = 0;
|
|
int rci = storage_event_send(DRIVE_EVT, ev.id, drive);
|
|
|
|
if (ev.id == SYS_HOTSWAP_INSERTED && !rci) {
|
|
mnt = disk_mount(drive);
|
|
}
|
|
|
|
if (umnt > 0 || mnt > 0) {
|
|
/* something was unmounted and/or mounted */
|
|
queue_broadcast(SYS_FS_CHANGED, drive);
|
|
}
|
|
}
|
|
break;
|
|
#endif /* HAVE_HOTSWAP */
|
|
|
|
#ifndef USB_NONE
|
|
case SYS_USB_CONNECTED:
|
|
case SYS_USB_DISCONNECTED:
|
|
bdcast = 0;
|
|
storage_event_send(CONFIG_STORAGE, ev.id, (intptr_t)&bdcast);
|
|
usb_mode = ev.id == SYS_USB_CONNECTED;
|
|
if (usb_mode) {
|
|
usb_acknowledge(SYS_USB_CONNECTED_ACK);
|
|
}
|
|
else {
|
|
bdcast = CONFIG_STORAGE;
|
|
}
|
|
break;
|
|
#endif /* ndef USB_NONE */
|
|
}
|
|
}
|
|
}
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
void storage_sleep(void)
|
|
{
|
|
if (storage_thread_id) {
|
|
queue_post(&storage_queue, Q_STORAGE_SLEEP, 0);
|
|
}
|
|
}
|
|
#endif /* (CONFIG_STORAGE & STORAGE_ATA) */
|
|
|
|
#ifdef STORAGE_CLOSE
|
|
void storage_close(void)
|
|
{
|
|
if (storage_thread_id) {
|
|
queue_post(&storage_queue, Q_STORAGE_CLOSE, 0);
|
|
thread_wait(storage_thread_id);
|
|
}
|
|
}
|
|
#endif /* STORAGE_CLOSE */
|
|
|
|
static inline void storage_thread_init(void)
|
|
{
|
|
if (storage_thread_id) {
|
|
return;
|
|
}
|
|
|
|
queue_init(&storage_queue, true);
|
|
storage_thread_id = create_thread(storage_thread, &storage_thread_stack,
|
|
sizeof (storage_thread_stack),
|
|
0, &storage_thread_name[1]
|
|
IF_PRIO(, PRIORITY_USER_INTERFACE)
|
|
IF_COP(, CPU));
|
|
}
|
|
|
|
int storage_init(void)
|
|
{
|
|
#ifdef CONFIG_STORAGE_MULTI
|
|
int rc=0;
|
|
int i;
|
|
num_drives=0;
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
if ((rc=ata_init())) return rc;
|
|
|
|
int ata_drives = ata_num_drives(num_drives);
|
|
for (i=0; i<ata_drives; i++)
|
|
{
|
|
storage_drivers[num_drives++] =
|
|
(STORAGE_ATA<<DRIVER_OFFSET) | (i << DRIVE_OFFSET);
|
|
}
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
if ((rc=mmc_init())) return rc;
|
|
|
|
int mmc_drives = mmc_num_drives(num_drives);
|
|
for (i=0; i<mmc_drives ;i++)
|
|
{
|
|
storage_drivers[num_drives++] =
|
|
(STORAGE_MMC<<DRIVER_OFFSET) | (i << DRIVE_OFFSET);
|
|
}
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
if ((rc=sd_init())) return rc;
|
|
|
|
int sd_drives = sd_num_drives(num_drives);
|
|
for (i=0; i<sd_drives; i++)
|
|
{
|
|
storage_drivers[num_drives++] =
|
|
(STORAGE_SD<<DRIVER_OFFSET) | (i << DRIVE_OFFSET);
|
|
}
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
if ((rc=nand_init())) return rc;
|
|
|
|
int nand_drives = nand_num_drives(num_drives);
|
|
for (i=0; i<nand_drives; i++)
|
|
{
|
|
storage_drivers[num_drives++] =
|
|
(STORAGE_NAND<<DRIVER_OFFSET) | (i << DRIVE_OFFSET);
|
|
}
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
if ((rc=ramdisk_init())) return rc;
|
|
|
|
int ramdisk_drives = ramdisk_num_drives(num_drives);
|
|
for (i=0; i<ramdisk_drives; i++)
|
|
{
|
|
storage_drivers[num_drives++] =
|
|
(STORAGE_RAMDISK<<DRIVER_OFFSET) | (i << DRIVE_OFFSET);
|
|
}
|
|
#endif
|
|
#else /* ndef CONFIG_STORAGE_MULTI */
|
|
STORAGE_FUNCTION(init)();
|
|
#endif /* CONFIG_STORAGE_MULTI */
|
|
|
|
storage_thread_init();
|
|
return 0;
|
|
}
|
|
|
|
int storage_read_sectors(IF_MD(int drive,) unsigned long start, int count,
|
|
void* buf)
|
|
{
|
|
#ifdef CONFIG_STORAGE_MULTI
|
|
int driver=(storage_drivers[drive] & DRIVER_MASK)>>DRIVER_OFFSET;
|
|
int ldrive=(storage_drivers[drive] & DRIVE_MASK)>>DRIVE_OFFSET;
|
|
|
|
switch (driver)
|
|
{
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
case STORAGE_ATA:
|
|
return ata_read_sectors(IF_MD(ldrive,) start,count,buf);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
case STORAGE_MMC:
|
|
return mmc_read_sectors(IF_MD(ldrive,) start,count,buf);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
case STORAGE_SD:
|
|
return sd_read_sectors(IF_MD(ldrive,) start,count,buf);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
case STORAGE_NAND:
|
|
return nand_read_sectors(IF_MD(ldrive,) start,count,buf);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
case STORAGE_RAMDISK:
|
|
return ramdisk_read_sectors(IF_MD(ldrive,) start,count,buf);
|
|
#endif
|
|
}
|
|
|
|
return -1;
|
|
#else /* CONFIG_STORAGE_MULTI */
|
|
return STORAGE_FUNCTION(read_sectors)(IF_MD(drive,)start,count,buf);
|
|
#endif /* CONFIG_STORAGE_MULTI */
|
|
|
|
}
|
|
|
|
int storage_write_sectors(IF_MD(int drive,) unsigned long start, int count,
|
|
const void* buf)
|
|
{
|
|
#ifdef CONFIG_STORAGE_MULTI
|
|
int driver=(storage_drivers[drive] & DRIVER_MASK)>>DRIVER_OFFSET;
|
|
int ldrive=(storage_drivers[drive] & DRIVE_MASK)>>DRIVE_OFFSET;
|
|
|
|
switch (driver)
|
|
{
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
case STORAGE_ATA:
|
|
return ata_write_sectors(IF_MD(ldrive,)start,count,buf);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
case STORAGE_MMC:
|
|
return mmc_write_sectors(IF_MD(ldrive,)start,count,buf);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
case STORAGE_SD:
|
|
return sd_write_sectors(IF_MD(ldrive,)start,count,buf);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
case STORAGE_NAND:
|
|
return nand_write_sectors(IF_MD(ldrive,)start,count,buf);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
case STORAGE_RAMDISK:
|
|
return ramdisk_write_sectors(IF_MD(ldrive,)start,count,buf);
|
|
#endif
|
|
}
|
|
|
|
return -1;
|
|
#else /* CONFIG_STORAGE_MULTI */
|
|
return STORAGE_FUNCTION(write_sectors)(IF_MD(drive,)start,count,buf);
|
|
#endif /* CONFIG_STORAGE_MULTI */
|
|
}
|
|
|
|
#ifdef CONFIG_STORAGE_MULTI
|
|
|
|
#define DRIVER_MASK 0xff000000
|
|
#define DRIVER_OFFSET 24
|
|
#define DRIVE_MASK 0x00ff0000
|
|
#define DRIVE_OFFSET 16
|
|
#define PARTITION_MASK 0x0000ff00
|
|
|
|
static unsigned int storage_drivers[NUM_DRIVES];
|
|
static unsigned int num_drives;
|
|
|
|
int storage_num_drives(void)
|
|
{
|
|
return num_drives;
|
|
}
|
|
|
|
int storage_driver_type(int drive)
|
|
{
|
|
if ((unsigned int)drive >= num_drives)
|
|
return -1;
|
|
|
|
unsigned int bit = (storage_drivers[drive] & DRIVER_MASK)>>DRIVER_OFFSET;
|
|
return bit ? find_first_set_bit(bit) : -1;
|
|
}
|
|
|
|
void storage_enable(bool on)
|
|
{
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
ata_enable(on);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
mmc_enable(on);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
sd_enable(on);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
nand_enable(on);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
ramdisk_enable(on);
|
|
#endif
|
|
}
|
|
|
|
void storage_sleepnow(void)
|
|
{
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
ata_sleepnow();
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
mmc_sleepnow();
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
//sd_sleepnow();
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
nand_sleepnow();
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
ramdisk_sleepnow();
|
|
#endif
|
|
}
|
|
|
|
bool storage_disk_is_active(void)
|
|
{
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
if (ata_disk_is_active()) return true;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
if (mmc_disk_is_active()) return true;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
//if (sd_disk_is_active()) return true;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
//if (nand_disk_is_active()) return true;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
if (ramdisk_disk_is_active()) return true;
|
|
#endif
|
|
|
|
return false;
|
|
}
|
|
|
|
int storage_soft_reset(void)
|
|
{
|
|
int rc=0;
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
if ((rc=ata_soft_reset())) return rc;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
if ((rc=mmc_soft_reset())) return rc;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
//if ((rc=sd_soft_reset())) return rc;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
//if ((rc=nand_soft_reset())) return rc;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
if ((rc=ramdisk_soft_reset())) return rc;
|
|
#endif
|
|
|
|
return rc;
|
|
}
|
|
|
|
#ifdef HAVE_STORAGE_FLUSH
|
|
int storage_flush(void)
|
|
{
|
|
int rc=0;
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
//if ((rc=ata_flush())) return rc;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
//if ((rc=mmc_flush())) return rc;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
//if ((rc=sd_flush())) return rc;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
if ((rc=nand_flush())) return rc;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
//if ((rc=ramdisk_flush())) return rc;
|
|
#endif
|
|
|
|
return rc;
|
|
}
|
|
#endif
|
|
|
|
void storage_spin(void)
|
|
{
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
ata_spin();
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
mmc_spin();
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
sd_spin();
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
nand_spin();
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
ramdisk_spin();
|
|
#endif
|
|
}
|
|
|
|
void storage_spindown(int seconds)
|
|
{
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
ata_spindown(seconds);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
mmc_spindown(seconds);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
sd_spindown(seconds);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
nand_spindown(seconds);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
ramdisk_spindown(seconds);
|
|
#endif
|
|
}
|
|
|
|
#if (CONFIG_LED == LED_REAL)
|
|
void storage_set_led_enabled(bool enabled)
|
|
{
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
ata_set_led_enabled(enabled);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
mmc_set_led_enabled(enabled);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
sd_set_led_enabled(enabled);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
nand_set_led_enabled(enabled);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
ramdisk_set_led_enabled(enabled);
|
|
#endif
|
|
}
|
|
#endif /* CONFIG_LED == LED_REAL */
|
|
|
|
long storage_last_disk_activity(void)
|
|
{
|
|
long max=0;
|
|
long t;
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
t=ata_last_disk_activity();
|
|
if (t>max) max=t;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
t=mmc_last_disk_activity();
|
|
if (t>max) max=t;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
t=sd_last_disk_activity();
|
|
if (t>max) max=t;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
t=nand_last_disk_activity();
|
|
if (t>max) max=t;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
t=ramdisk_last_disk_activity();
|
|
if (t>max) max=t;
|
|
#endif
|
|
|
|
return max;
|
|
}
|
|
|
|
int storage_spinup_time(void)
|
|
{
|
|
int max=0;
|
|
int t;
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
t=ata_spinup_time();
|
|
if (t>max) max=t;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
t=mmc_spinup_time();
|
|
if (t>max) max=t;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
//t=sd_spinup_time();
|
|
//if (t>max) max=t;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
t=nand_spinup_time();
|
|
if (t>max) max=t;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
t=ramdisk_spinup_time();
|
|
if (t>max) max=t;
|
|
#endif
|
|
|
|
return max;
|
|
}
|
|
|
|
#ifdef STORAGE_GET_INFO
|
|
void storage_get_info(int drive, struct storage_info *info)
|
|
{
|
|
int driver=(storage_drivers[drive] & DRIVER_MASK)>>DRIVER_OFFSET;
|
|
int ldrive=(storage_drivers[drive] & DRIVE_MASK)>>DRIVE_OFFSET;
|
|
|
|
switch(driver)
|
|
{
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
case STORAGE_ATA:
|
|
return ata_get_info(ldrive,info);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
case STORAGE_MMC:
|
|
return mmc_get_info(ldrive,info);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
case STORAGE_SD:
|
|
return sd_get_info(ldrive,info);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
case STORAGE_NAND:
|
|
return nand_get_info(ldrive,info);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
case STORAGE_RAMDISK:
|
|
return ramdisk_get_info(ldrive,info);
|
|
#endif
|
|
}
|
|
}
|
|
#endif /* STORAGE_GET_INFO */
|
|
|
|
#ifdef HAVE_HOTSWAP
|
|
bool storage_removable(int drive)
|
|
{
|
|
int driver=(storage_drivers[drive] & DRIVER_MASK)>>DRIVER_OFFSET;
|
|
int ldrive=(storage_drivers[drive] & DRIVE_MASK)>>DRIVE_OFFSET;
|
|
|
|
switch(driver)
|
|
{
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
case STORAGE_ATA:
|
|
return false;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
case STORAGE_MMC:
|
|
return mmc_removable(ldrive);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
case STORAGE_SD:
|
|
return sd_removable(ldrive);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
case STORAGE_NAND:
|
|
return false;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
case STORAGE_RAMDISK:
|
|
return false;
|
|
#endif
|
|
|
|
default:
|
|
return false;
|
|
}
|
|
}
|
|
|
|
bool storage_present(int drive)
|
|
{
|
|
int driver=(storage_drivers[drive] & DRIVER_MASK)>>DRIVER_OFFSET;
|
|
int ldrive=(storage_drivers[drive] & DRIVE_MASK)>>DRIVE_OFFSET;
|
|
|
|
switch(driver)
|
|
{
|
|
#if (CONFIG_STORAGE & STORAGE_ATA)
|
|
case STORAGE_ATA:
|
|
return true;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_MMC)
|
|
case STORAGE_MMC:
|
|
return mmc_present(ldrive);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_SD)
|
|
case STORAGE_SD:
|
|
return sd_present(ldrive);
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_NAND)
|
|
case STORAGE_NAND:
|
|
return true;
|
|
#endif
|
|
|
|
#if (CONFIG_STORAGE & STORAGE_RAMDISK)
|
|
case STORAGE_RAMDISK:
|
|
return true;
|
|
#endif
|
|
|
|
default:
|
|
return false;
|
|
}
|
|
}
|
|
#endif /* HAVE_HOTSWAP */
|
|
#endif /*CONFIG_STORAGE_MULTI*/
|