23f157eb76
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@4152 a1c6a512-1295-4272-9138-f99709370657
366 lines
8.8 KiB
C
366 lines
8.8 KiB
C
/***************************************************************************
|
|
* __________ __ ___.
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
* \/ \/ \/ \/ \/
|
|
* $Id$
|
|
*
|
|
* Copyright (C) 2002 by Linus Nielsen Feltzing
|
|
*
|
|
* All files in this archive are subject to the GNU General Public License.
|
|
* See the file COPYING in the source tree root for full license agreement.
|
|
*
|
|
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
|
* KIND, either express or implied.
|
|
*
|
|
****************************************************************************/
|
|
#include "config.h"
|
|
#include "sh7034.h"
|
|
#include "kernel.h"
|
|
#include "thread.h"
|
|
#include "system.h"
|
|
#include "debug.h"
|
|
#include "ata.h"
|
|
#include "fat.h"
|
|
#include "disk.h"
|
|
#include "panic.h"
|
|
#include "lcd.h"
|
|
#include "adc.h"
|
|
#include "usb.h"
|
|
#include "button.h"
|
|
#include "sprintf.h"
|
|
#include "hwcompat.h"
|
|
|
|
extern void dbg_ports(void); /* NASTY! defined in apps/ */
|
|
|
|
#define USB_REALLY_BRAVE
|
|
|
|
#if !defined(SIMULATOR) && !defined(USB_NONE)
|
|
|
|
/* Messages from usb_tick */
|
|
#define USB_INSERTED 1
|
|
#define USB_EXTRACTED 2
|
|
|
|
/* Thread states */
|
|
#define EXTRACTING 1
|
|
#define EXTRACTED 2
|
|
#define INSERTED 3
|
|
#define INSERTING 4
|
|
|
|
/* The ADC tick reads one channel per tick, and we want to check 3 successive
|
|
readings on the USB voltage channel. This doesn't apply to the Player, but
|
|
debouncing the USB detection port won't hurt us either. */
|
|
#define NUM_POLL_READINGS (NUM_ADC_CHANNELS * 3)
|
|
static int countdown;
|
|
|
|
static int usb_state;
|
|
|
|
static char usb_stack[DEFAULT_STACK_SIZE];
|
|
static char usb_thread_name[] = "usb";
|
|
static struct event_queue usb_queue;
|
|
static bool last_usb_status;
|
|
static bool usb_monitor_enabled;
|
|
|
|
static void usb_enable(bool on)
|
|
{
|
|
#ifdef HAVE_LCD_BITMAP
|
|
if(read_hw_mask() & USB_ACTIVE_HIGH)
|
|
on = !on;
|
|
#endif
|
|
|
|
if(on)
|
|
{
|
|
and_b(~0x04, &PADRH); /* enable USB */
|
|
}
|
|
else
|
|
{
|
|
or_b(0x04, &PADRH);
|
|
}
|
|
or_b(0x04, &PAIORH);
|
|
}
|
|
|
|
static void usb_slave_mode(bool on)
|
|
{
|
|
int rc;
|
|
struct partinfo* pinfo;
|
|
|
|
if(on)
|
|
{
|
|
DEBUGF("Entering USB slave mode\n");
|
|
ata_soft_reset();
|
|
ata_init();
|
|
ata_standby(15);
|
|
ata_enable(false);
|
|
usb_enable(true);
|
|
}
|
|
else
|
|
{
|
|
DEBUGF("Leaving USB slave mode\n");
|
|
|
|
/* Let the ISDx00 settle */
|
|
sleep(HZ*1);
|
|
|
|
usb_enable(false);
|
|
|
|
rc = ata_init();
|
|
if(rc)
|
|
{
|
|
char str[32];
|
|
lcd_clear_display();
|
|
snprintf(str, 31, "ATA error: %d", rc);
|
|
lcd_puts(0, 0, str);
|
|
lcd_puts(0, 1, "Press ON to debug");
|
|
lcd_update();
|
|
while(button_get(true) != BUTTON_ON) {};
|
|
dbg_ports();
|
|
panicf("ata: %d",rc);
|
|
}
|
|
|
|
pinfo = disk_init();
|
|
if (!pinfo)
|
|
panicf("disk: NULL");
|
|
|
|
rc = fat_mount(pinfo[0].start);
|
|
if(rc)
|
|
panicf("mount: %d",rc);
|
|
}
|
|
}
|
|
|
|
static void usb_thread(void)
|
|
{
|
|
int num_acks_to_expect = -1;
|
|
bool waiting_for_ack;
|
|
struct event ev;
|
|
|
|
waiting_for_ack = false;
|
|
|
|
while(1)
|
|
{
|
|
queue_wait(&usb_queue, &ev);
|
|
switch(ev.id)
|
|
{
|
|
case USB_INSERTED:
|
|
/* Tell all threads that they have to back off the ATA.
|
|
We subtract one for our own thread. */
|
|
num_acks_to_expect =
|
|
queue_broadcast(SYS_USB_CONNECTED, NULL) - 1;
|
|
waiting_for_ack = true;
|
|
DEBUGF("USB inserted. Waiting for ack from %d threads...\n",
|
|
num_acks_to_expect);
|
|
break;
|
|
|
|
case SYS_USB_CONNECTED_ACK:
|
|
if(waiting_for_ack)
|
|
{
|
|
num_acks_to_expect--;
|
|
if(num_acks_to_expect == 0)
|
|
{
|
|
DEBUGF("All threads have acknowledged the connect.\n");
|
|
#ifdef USB_REALLY_BRAVE
|
|
usb_slave_mode(true);
|
|
usb_state = USB_INSERTED;
|
|
#else
|
|
system_reboot();
|
|
#endif
|
|
}
|
|
else
|
|
{
|
|
DEBUGF("usb: got ack, %d to go...\n",
|
|
num_acks_to_expect);
|
|
}
|
|
}
|
|
break;
|
|
|
|
case USB_EXTRACTED:
|
|
if(usb_state == USB_INSERTED)
|
|
{
|
|
/* Only disable the USB mode if we really have enabled it
|
|
some threads might not have acknowledged the
|
|
insertion */
|
|
usb_slave_mode(false);
|
|
}
|
|
|
|
usb_state = USB_EXTRACTED;
|
|
|
|
/* Tell all threads that we are back in business */
|
|
num_acks_to_expect =
|
|
queue_broadcast(SYS_USB_DISCONNECTED, NULL) - 1;
|
|
waiting_for_ack = true;
|
|
DEBUGF("USB extracted. Waiting for ack from %d threads...\n",
|
|
num_acks_to_expect);
|
|
#ifdef HAVE_LCD_CHARCELLS
|
|
lcd_icon(ICON_USB, false);
|
|
#endif
|
|
break;
|
|
|
|
case SYS_USB_DISCONNECTED_ACK:
|
|
if(waiting_for_ack)
|
|
{
|
|
num_acks_to_expect--;
|
|
if(num_acks_to_expect == 0)
|
|
{
|
|
DEBUGF("All threads have acknowledged. "
|
|
"We're in business.\n");
|
|
}
|
|
else
|
|
{
|
|
DEBUGF("usb: got ack, %d to go...\n",
|
|
num_acks_to_expect);
|
|
}
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
bool usb_detect(void)
|
|
{
|
|
bool current_status;
|
|
|
|
#ifdef USB_RECORDERSTYLE
|
|
current_status = (adc_read(ADC_USB_POWER) > 500)?true:false;
|
|
#endif
|
|
#ifdef USB_FMRECORDERSTYLE
|
|
current_status = (adc_read(ADC_USB_POWER) <= 512)?true:false;
|
|
#endif
|
|
#ifdef USB_PLAYERSTYLE
|
|
current_status = (PADR & 0x8000)?false:true;
|
|
#endif
|
|
|
|
return current_status;
|
|
}
|
|
|
|
|
|
static void usb_tick(void)
|
|
{
|
|
bool current_status;
|
|
|
|
if(usb_monitor_enabled)
|
|
{
|
|
current_status = usb_detect();
|
|
|
|
/* Only report when the status has changed */
|
|
if(current_status != last_usb_status)
|
|
{
|
|
last_usb_status = current_status;
|
|
countdown = NUM_POLL_READINGS;
|
|
}
|
|
else
|
|
{
|
|
/* Count down until it gets negative */
|
|
if(countdown >= 0)
|
|
countdown--;
|
|
|
|
/* Report to the thread if we have had 3 identical status
|
|
readings in a row */
|
|
if(countdown == 0)
|
|
{
|
|
if(current_status)
|
|
queue_post(&usb_queue, USB_INSERTED, NULL);
|
|
else
|
|
queue_post(&usb_queue, USB_EXTRACTED, NULL);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void usb_acknowledge(int id)
|
|
{
|
|
queue_post(&usb_queue, id, NULL);
|
|
}
|
|
|
|
void usb_init(void)
|
|
{
|
|
usb_state = USB_EXTRACTED;
|
|
usb_monitor_enabled = false;
|
|
countdown = -1;
|
|
|
|
usb_enable(false);
|
|
|
|
/* We assume that the USB cable is extracted */
|
|
last_usb_status = false;
|
|
|
|
queue_init(&usb_queue);
|
|
create_thread(usb_thread, usb_stack, sizeof(usb_stack), usb_thread_name);
|
|
|
|
tick_add_task(usb_tick);
|
|
}
|
|
|
|
void usb_wait_for_disconnect(struct event_queue *q)
|
|
{
|
|
struct event ev;
|
|
|
|
/* Don't return until we get SYS_USB_DISCONNECTED */
|
|
while(1)
|
|
{
|
|
queue_wait(q, &ev);
|
|
if(ev.id == SYS_USB_DISCONNECTED)
|
|
{
|
|
usb_acknowledge(SYS_USB_DISCONNECTED_ACK);
|
|
return;
|
|
}
|
|
}
|
|
}
|
|
|
|
int usb_wait_for_disconnect_w_tmo(struct event_queue *q, int ticks)
|
|
{
|
|
struct event ev;
|
|
|
|
/* Don't return until we get SYS_USB_DISCONNECTED or SYS_TIMEOUT */
|
|
while(1)
|
|
{
|
|
queue_wait_w_tmo(q, &ev, ticks);
|
|
switch(ev.id)
|
|
{
|
|
case SYS_USB_DISCONNECTED:
|
|
usb_acknowledge(SYS_USB_DISCONNECTED_ACK);
|
|
return 0;
|
|
break;
|
|
case SYS_TIMEOUT:
|
|
return 1;
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
void usb_start_monitoring(void)
|
|
{
|
|
usb_monitor_enabled = true;
|
|
}
|
|
|
|
bool usb_inserted(void)
|
|
{
|
|
return usb_state == USB_INSERTED;
|
|
}
|
|
|
|
#else
|
|
|
|
#ifdef USB_NONE
|
|
bool usb_inserted(void)
|
|
{
|
|
return false;
|
|
}
|
|
#endif
|
|
|
|
/* Dummy simulator functions */
|
|
void usb_acknowledge(int id)
|
|
{
|
|
id = id;
|
|
}
|
|
|
|
void usb_init(void)
|
|
{
|
|
}
|
|
|
|
void usb_start_monitoring(void)
|
|
{
|
|
}
|
|
|
|
bool usb_detect(void)
|
|
{
|
|
return false;
|
|
}
|
|
|
|
#endif /* USB_NONE or SIMULATOR */
|