gpio.c

Centrality Atlas II development software

/*
 * $QNXLicenseC: 
 * Copyright 2007,2008, QNX Software Systems.  
 *  
 * Licensed under the Apache License, Version 2.0 (the "License"). You  
 * may not reproduce, modify or distribute this software except in  
 * compliance with the License. You may obtain a copy of the License  
 * at: http://www.apache.org/licenses/LICENSE-2.0  
 *  
 * Unless required by applicable law or agreed to in writing, software  
 * distributed under the License is distributed on an "AS IS" basis,  
 * WITHOUT WARRANTIES OF ANY KIND, either express or implied. 
 * 
 * This file may contain contributions from others, either as  
 * contributors under the License or as licensors under other terms.   
 * Please review this entire file for other proprietary rights or license  
 * notices, as well as the QNX Development Suite License Guide at  
 * http://licensing.qnx.com/license-guide/ for other information. 
 * $ 
 */






#include "startup.h"
#include "gpio.h"

uint32_t ConfigGPIO(uint8_t reg, uint8_t gpio_num, uint32_t data, uint8_t bitop, uint8_t regop)
{
	uint32_t ret=0;
	int grp=0, off=0;
	uint32_t base;
	grp=gpio_num/32;
	off=gpio_num%32;
	if(reg==GPIO_CTRL)
	{
		base=GPIO_BASE+0x100*grp+off*4;
	}
	else
	{
		base=GPIO_BASE+0x100*grp+reg;
	}
	
	ret=in32(base);
	if(regop!=GPIO_READ)
	{
		if(bitop==GPIO_BITCLR)
			ret &=~(data);
		else
			ret|=data;
		out32(base, ret);
	}
		
	return ret;
}