Subversion Repositories freemyipod

//
//
//    Copyright 2010 TheSeven
//
//
//    This file is part of emCORE.
//
//    emCORE 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.
//
//    emCORE 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 emCORE.  If not, see <http://www.gnu.org/licenses/>.
//
//


#include "global.h"
#include "s5l8720.h"


uint32_t clockgates_dma[2];

bool clockgate_get_state(int gate)
{
    return !(PWRCON(gate >> 5) & (1 << (gate & 0x1f)));
}

void clockgate_enable(int gate, bool enable)
{
    uint32_t mode = enter_critical_section();
    if (enable) PWRCON(gate >> 5) &= ~(1 << (gate & 0x1f));
    else PWRCON(gate >> 5) |= 1 << (gate & 0x1f);
    leave_critical_section(mode);
}

void clockgate_dma(int dmac, int chan, bool enable)
{
    uint32_t mode = enter_critical_section();
    uint32_t old = clockgates_dma[dmac];
    if (enable) clockgates_dma[dmac] |= 1 << chan;
    else clockgates_dma[dmac] &= ~(1 << chan);
//TODO: Figure out DMAC clock gates     
//    if (clockgates_dma[dmac] != old)
//        clockgate_enable(CLOCKGATE_DMA(dmac), true);
    leave_critical_section(mode);
}