/* Copyright Statement:
 * 
 * This software/firmware and related documentation ("MediaTek Software") are 
 * protected under relevant copyright laws. The information contained herein is 
 * confidential and proprietary to MediaTek Inc. and/or its licensors. Without 
 * the prior written permission of MediaTek inc. and/or its licensors, any 
 * reproduction, modification, use or disclosure of MediaTek Software, and 
 * information contained herein, in whole or in part, shall be strictly 
 * prohibited.  
 * 
 * MediaTek Inc. (C) 2010. All rights reserved.
 * 
 * BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES 
 * THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE") 
 * RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER ON 
 * AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES, 
 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF 
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT. NEITHER 
 * DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE SOFTWARE OF 
 * ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR SUPPLIED WITH THE 
 * MEDIATEK SOFTWARE, AND RECEIVER AGREES TO LOOK ONLY TO SUCH THIRD PARTY FOR 
 * ANY WARRANTY CLAIM RELATING THERETO. RECEIVER EXPRESSLY ACKNOWLEDGES THAT IT 
 * IS RECEIVER'S SOLE RESPONSIBILITY TO OBTAIN FROM ANY THIRD PARTY ALL PROPER 
 * LICENSES CONTAINED IN MEDIATEK SOFTWARE. MEDIATEK SHALL ALSO NOT BE 
 * RESPONSIBLE FOR ANY MEDIATEK SOFTWARE RELEASES MADE TO RECEIVER'S 
 * SPECIFICATION OR TO CONFORM TO A PARTICULAR STANDARD OR OPEN FORUM. 
 * RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND CUMULATIVE 
 * LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE,
 *  AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE, 
 * OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY RECEIVER TO 
 * MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
 */
/*
 * Copyright (c) 2008, Google Inc.
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *  * Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 *  * Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in
 *    the documentation and/or other materials provided with the 
 *    distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
 * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
 * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 
 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
 * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 */

#include <boot/boot.h>
#include <msm7k/gpio.h>

/* gross */

typedef struct gpioregs gpioregs;

struct gpioregs
{
    unsigned out;
    unsigned in;
    unsigned int_status;
    unsigned int_clear;
    unsigned int_en;
    unsigned int_edge;
    unsigned int_pos;
    unsigned oe;
};

static gpioregs GPIO_REGS[] = {
    {
        .out =         GPIO_OUT_0,
        .in =          GPIO_IN_0,
        .int_status =  GPIO_INT_STATUS_0,
        .int_clear =   GPIO_INT_CLEAR_0,
        .int_en =      GPIO_INT_EN_0,
        .int_edge =    GPIO_INT_EDGE_0,
        .int_pos =     GPIO_INT_POS_0,
        .oe =          GPIO_OE_0,
    },
    {
        .out =         GPIO_OUT_1,
        .in =          GPIO_IN_1,
        .int_status =  GPIO_INT_STATUS_1,
        .int_clear =   GPIO_INT_CLEAR_1,
        .int_en =      GPIO_INT_EN_1,
        .int_edge =    GPIO_INT_EDGE_1,
        .int_pos =     GPIO_INT_POS_1,
        .oe =          GPIO_OE_1,
    },
    {
        .out =         GPIO_OUT_2,
        .in =          GPIO_IN_2,
        .int_status =  GPIO_INT_STATUS_2,
        .int_clear =   GPIO_INT_CLEAR_2,
        .int_en =      GPIO_INT_EN_2,
        .int_edge =    GPIO_INT_EDGE_2,
        .int_pos =     GPIO_INT_POS_2,
        .oe =          GPIO_OE_2,
    },
    {
        .out =         GPIO_OUT_3,
        .in =          GPIO_IN_3,
        .int_status =  GPIO_INT_STATUS_3,
        .int_clear =   GPIO_INT_CLEAR_3,
        .int_en =      GPIO_INT_EN_3,
        .int_edge =    GPIO_INT_EDGE_3,
        .int_pos =     GPIO_INT_POS_3,
        .oe =          GPIO_OE_3,
    },
    {
        .out =         GPIO_OUT_4,
        .in =          GPIO_IN_4,
        .int_status =  GPIO_INT_STATUS_4,
        .int_clear =   GPIO_INT_CLEAR_4,
        .int_en =      GPIO_INT_EN_4,
        .int_edge =    GPIO_INT_EDGE_4,
        .int_pos =     GPIO_INT_POS_4,
        .oe =          GPIO_OE_4,
    },
};

static gpioregs *find_gpio(unsigned n, unsigned *bit)
{
    if(n > 106) return 0;
    if(n > 94) {
        *bit = 1 << (n - 95);
        return GPIO_REGS + 4;
    }
    if(n > 67) {
        *bit = 1 << (n - 68);
        return GPIO_REGS + 3;
    }
    if(n > 42) {
        *bit = 1 << (n - 43);
        return GPIO_REGS + 2;
    }
    if(n > 15) {
        *bit = 1 << (n - 16);
        return GPIO_REGS + 1;
    }
    *bit = 1 << n;
    return GPIO_REGS + 0;
}

void gpio_output_enable(unsigned n, unsigned out)
{
    gpioregs *r;
    unsigned b;
    unsigned v;
    
    if((r = find_gpio(n, &b)) == 0) return;

    v = readl(r->oe);
    if(out) {
        writel(v | b, r->oe);
    } else {
        writel(v & (~b), r->oe);
    }
}

void gpio_write(unsigned n, unsigned on)
{
    gpioregs *r;
    unsigned b;
    unsigned v;
    
    if((r = find_gpio(n, &b)) == 0) return;

    v = readl(r->out);
    if(on) {
        writel(v | b, r->out);
    } else {
        writel(v & (~b), r->out);
    }
}

int gpio_read(unsigned n)
{
    gpioregs *r;
    unsigned b;
    
    if((r = find_gpio(n, &b)) == 0) return 0;

    return (readl(r->in) & b) ? 1 : 0;
}

void gpio_dir(int nr, int out)
{
	gpio_output_enable(nr, out);
}

void gpio_set(int nr, int set)
{
	gpio_write(nr, set);
}

int gpio_get(int nr)
{
	return gpio_read(nr);
}


