/***************************************************************
 *
 * OpenBeacon.org - Power Management
 *
 * Copyright 2010 Milosch Meriac <meriac@openbeacon.de>
 *
 ***************************************************************

    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; version 2.

    This program is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU General Public License along
    with this program; if not, write to the Free Software Foundation, Inc.,
    51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.

*/
#include <openbeacon.h>
#include "pin.h"
#include "pmu.h"

/* Watchdog oscillator control register setup */
#define FREQSEL 1
#define FCLKANA 500000.0
#define DIVSEL 0x1F
#define WDT_OSC_CLK (FCLKANA/(2.0*(1+DIVSEL)))

#define MAINCLKSEL_IRC_OSC 0
#define MAINCLKSEL_SYS_PLL 1
#define MAINCLKSEL_WDT_OSC 2
#define MAINCLKSEL_SYS_PLL_OUT 3

static const uint32_t pmu_reason_signature = 0xDEADBEEF;

void
deep_sleep_ms (uint32_t milliseconds)
{
  (void) milliseconds;

  /* back up current power states */
  LPC_SYSCON->PDAWAKECFG = LPC_SYSCON->PDRUNCFG;
  __asm volatile ("WFI");
}

void
pmu_sleep (void)
{
}

void
pmu_off (uint32_t reason)
{
  LPC_PMU->GPREG0 = pmu_reason_signature;
  LPC_PMU->GPREG1 = reason;

  LPC_SYSCON->PDSLEEPCFG = 0xFFFFFFFF;
  SCB->SCR |= NVIC_LP_SLEEPDEEP;
  LPC_PMU->PCON = 0x2;
  pin_mode_pmu (1);
  __WFI ();
}

uint32_t
pmu_reason (void)
{
  return (LPC_PMU->GPREG0==pmu_reason_signature)?LPC_PMU->GPREG1:0;
}

void
pmu_init (void)
{
  pin_mode_pmu (0);
}