rockbox/firmware/target/arm/philips/sa9200/power-sa9200.c
2009-06-19 03:41:52 +00:00

109 lines
2.9 KiB
C

/***************************************************************************
* __________ __ ___.
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
* \/ \/ \/ \/ \/
* $Id$
*
* Copyright (C) 2006 by Daniel Ankers
*
* 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 <stdbool.h>
#include "system.h"
#include "cpu.h"
#include "ascodec.h"
#include "as3514.h"
#include "power.h"
#include "synaptics-mep.h"
#include "logf.h"
void power_init(void)
{
#ifndef BOOTLOADER
/* Power on and initialize the touchpad here because we need it for
both buttons and button lights */
DEV_INIT2 &= ~0x800;
char byte = ascodec_read(AS3514_CVDD_DCDC3);
byte = (byte & ~0x18) | 0x08;
ascodec_write(AS3514_CVDD_DCDC3, byte);
/* LEDs for REW, FFWD, MENU */
GPIOD_ENABLE |= (0x40 | 0x20 | 0x04);
GPIOD_OUTPUT_VAL |= (0x40 | 0x20 | 0x04);
GPIOD_OUTPUT_EN |= (0x40 | 0x20 | 0x04);
udelay(20000);
GPIOL_ENABLE |= 0x10;
GPIOL_OUTPUT_VAL &= ~0x10;
GPIOL_OUTPUT_EN |= 0x10;
udelay(100000);
/* enable DATA, ACK, CLK lines */
GPIOD_ENABLE |= (0x10 | 0x08 | 0x02);
GPIOD_OUTPUT_EN |= 0x08; /* ACK */
GPIOD_OUTPUT_VAL |= 0x08; /* high */
GPIOD_OUTPUT_EN &= ~0x02; /* CLK */
GPIOD_OUTPUT_EN |= 0x10; /* DATA */
GPIOD_OUTPUT_VAL |= 0x10; /* high */
if (!touchpad_init())
{
logf("touchpad not ready");
}
#endif
}
void power_off(void)
{
char byte;
/* Send shutdown command to PMU */
byte = ascodec_read(AS3514_SYSTEM);
byte &= ~0x1;
ascodec_write(AS3514_SYSTEM, byte);
/* Stop interrupts on both cores */
disable_interrupt(IRQ_FIQ_STATUS);
COP_INT_DIS = -1;
CPU_INT_DIS = -1;
/* Halt everything and wait for device to power off */
while (1)
{
COP_CTL = 0x40000000;
CPU_CTL = 0x40000000;
}
}
unsigned int power_input_status(void)
{
unsigned int status = POWER_INPUT_NONE;
/* GPIOF indicates that the connector is present,
GPIOB indicates that there's power there too.
Same status bits for both USB and the charger. */
if (!(GPIOF_INPUT_VAL & 0x80) && (GPIOB_INPUT_VAL & 0x40))
status = POWER_INPUT_MAIN_CHARGER;
return status;
}
void ide_power_enable(bool on)
{
(void)on;
}