[nprove][kernel][gpio] added nprove rtl8196c gpio support

3 files changed, 297 insertions, 0 deletions

diff --git a/package/gpio_rtl8196c/Makefile b/package/gpio_rtl8196c/Makefile
new file mode 100644
index 000000000..45dc5cffe
--- /dev/null
+++ b/package/gpio_rtl8196c/Makefile
@@ -0,0 +1,62 @@
+#
+# Copyright (C) 2011 Roman Yeryomin <roman@advem.lv>
+#
+# This is free software, licensed under the GNU General Public License v2.
+# See /LICENSE for more information.
+#
+
+include $(TOPDIR)/rules.mk
+include $(INCLUDE_DIR)/kernel.mk
+
+PKG_NAME:=gpio_rtl8196c
+PKG_VERSION:=0.0.1
+PKG_RELEASE:=1
+
+include $(INCLUDE_DIR)/package.mk
+
+define KernelPackage/gpio_rtl8196c
+	SUBMENU:=gpio_rtl8196c
+	TITLE:=gpio_rtl8196c
+	FILES:=$(PKG_BUILD_DIR)/gpio_rtl8196c.ko
+	DEPENDS:=
+	#KCONFIG:=
+	KCONFIG:=CONFIG_GPIO_RTL8196C=y CONFIG_GPIOLIB=y CONFIG_GENERIC_GPIO=y CONFIG_ARCH_WANT_OPTIONAL_GPIOLIB=y
+	#AUTOLOAD:=$(call AutoLoad,01,sigb in)
+endef
+
+define KernelPackage/gpio_rtl8196c/description
+	GPIO for Realtek rtl8196c
+endef
+
+EXTRA_KCONFIG:=CONFIG_GPIO_RTL8196C=y
+EXTRA_KCONFIG+=CONFIG_ARCH_WANT_OPTIONAL_GPIOLIB=y
+EXTRA_KCONFIG+=CONFIG_ARCH_REQUIRE_GPIOLIB=y
+EXTRA_KCONFIG+=CONFIG_GENERIC_GPIO=y
+EXTRA_KCONFIG+=CONFIG_GPIOLIB=y
+
+EXTRA_CFLAGS:= \
+	$(patsubst CONFIG_%, -DCONFIG_%=1, $(patsubst %=m,%,$(filter %=m,$(EXTRA_KCONFIG)))) \
+	$(patsubst CONFIG_%, -DCONFIG_%=1, $(patsubst %=y,%,$(filter %=y,$(EXTRA_KCONFIG))))
+
+MAKE_OPTS:= \
+	ARCH="$(LINUX_KARCH)" \
+	CROSS_COMPILE="$(TARGET_CROSS)" \
+	SUBDIRS="$(PKG_BUILD_DIR)" \
+	EXTRA_CFLAGS="$(EXTRA_CFLAGS)" \
+	$(EXTRA_KCONFIG)
+#	MVER="-DMODULE -DMODVERSIONS -DEXPORT_SYMTAB"
+
+
+define Build/Prepare
+	mkdir -p $(PKG_BUILD_DIR)
+	$(CP) ./src/* $(PKG_BUILD_DIR)/
+endef
+
+define Build/Compile
+	$(MAKE) -C "$(LINUX_DIR)" \
+		 $(MAKE_OPTS) \
+		modules
+	$(CP) $(PKG_BUILD_DIR)/gpio_rtl8196c.ko /tmp
+endef
+
+$(eval $(call KernelPackage,gpio_rtl8196c))
diff --git a/package/gpio_rtl8196c/src/Makefile b/package/gpio_rtl8196c/src/Makefile
new file mode 100644
index 000000000..6740c78db
--- /dev/null
+++ b/package/gpio_rtl8196c/src/Makefile
@@ -0,0 +1,8 @@
+#ifeq (${MODVERSIONS},yes)
+#    MVER=-DMODVERSIONS -DEXPORT_SYMTAB
+#endif
+
+
+obj-$(if $(CONFIG_GPIO_RTL8196C),m) += gpio_rtl8196c.o
+
+
diff --git a/package/gpio_rtl8196c/src/gpio_rtl8196c.c b/package/gpio_rtl8196c/src/gpio_rtl8196c.c
new file mode 100644
index 000000000..5b875be12
--- /dev/null
+++ b/package/gpio_rtl8196c/src/gpio_rtl8196c.c
@@ -0,0 +1,227 @@
+/*
+ * 
+ *
+ * Copyright (C)2006-2008 by 
+ * All rights reserved.
+ *
+ */
+ 
+#include <linux/init.h>
+#include <linux/module.h>
+#include <linux/gpio.h>
+#include <linux/stat.h>
+#include <linux/moduleparam.h>
+
+////////////////////////////////////////////////////////////////////////
+//DEBUG macroses
+#define MOD_NAME "gpio_rtl8196c"
+
+#define PRINT( format, args ...) printk( "%15s:%3d = " format, MOD_NAME,__LINE__, ##args)
+
+////////////////////////////////////////////////////////////////////////
+#define RTL8196C_BASE_ADDR		0xb8000000
+#define RTL8196C_GPIO_ADDR		(RTL8196C_BASE_ADDR + 0x3500)
+#define RTL8196C_GPIO_PABCD_CNT_ADDR	(RTL8196C_GPIO_ADDR + 0x00)
+#define RTL8196C_GPIO_PABCD_TYPE_ADDR	(RTL8196C_GPIO_ADDR + 0x00)
+#define RTL8196C_GPIO_PABCD_DIR_ADDR	(RTL8196C_GPIO_ADDR + 0x08)
+#define RTL8196C_GPIO_PABCD_DAT_ADDR	(RTL8196C_GPIO_ADDR + 0x0c)
+#define RTL8196C_GPIO_PABCD_ISR_ADDR	(RTL8196C_GPIO_ADDR + 0x10)
+#define RTL8196C_GPIO_PAB_IMR_ADDR	(RTL8196C_GPIO_ADDR + 0x14)
+#define RTL8196C_GPIO_PCD_IMR_ADDR	(RTL8196C_GPIO_ADDR + 0x18)
+
+#define RTL8196C_MUX_ADDR		(RTL8196C_BASE_ADDR + 0x40)
+
+static int g_muxdummy;
+
+//gpio shared pin mapping list
+#define RTL8196C_GPIO_SPML_LED_S0	//LED_PORT0,GPIOB2
+#define RTL8196C_GPIO_SPML_LED_S1	//LED_PORT1,GPIOB3
+#define RTL8196C_GPIO_SPML_LED_S2	//LED_PORT2,GPIOB4
+#define RTL8196C_GPIO_SPML_LED_S3	//LED_PORT3,GPIOB5
+#define RTL8196C_GPIO_SPML_LED_P0	//LED_PORT4,GPIOB6
+#define RTL8196C_GPIO_SPML_LED_P1	//GPIOB7
+#define RTL8196C_GPIO_SPML_LED_P2	//GPIOC0
+#define RTL8196C_GPIO_SPML_MEM		//NF_CS1#MCS1, DRAM_CKE, GPIOA[1:0]
+#define RTL8196C_GPIO_SPML_JTAG		//JTAG, GPIOA[6:2]
+#define RTL8196C_GPIO_SPML_UART		
+#define RTL8196C_GPIO_SPML_PCIE		
+
+static uint32_t rtl8196c_mux_value	=	0x340FFF;
+
+struct rtl_gpio_chip 
+{
+	struct gpio_chip	chip;
+	uint32_t		gpio_cnt;
+	uint32_t		gpio_data;
+	uint32_t		gpio_dir;
+	volatile uint8_t*	regs;
+	spinlock_t		lock;/* Lock used for synchronization */
+};
+
+extern struct rtl_gpio_chip gpio_rtl8196c;
+
+static inline struct rtl_gpio_chip *to_rtl_gpio_chip(struct gpio_chip *gc)
+{
+	return container_of(gc, struct rtl_gpio_chip, chip);
+}
+
+////////////////////////////////////////////////////////////////////////
+//configure ports as GPIO
+static int param_set_rtl8196c_mux( const char *val, struct kernel_param *kp )
+{
+	volatile uint32_t *mux = (uint32_t *)RTL8196C_MUX_ADDR;
+	unsigned long flags;
+	
+	PRINT("param_set_rtl8196c_mux\n");
+	if ( !val )
+	{
+		return -EINVAL;
+	}
+	if ( sscanf( val, "0x%x", &rtl8196c_mux_value ) < 0 )
+	{
+		PRINT("err val\n");
+		return -EINVAL;
+	}
+	spin_lock_irqsave(&gpio_rtl8196c.lock, flags);
+	PRINT("mux set 0x%08x\n",rtl8196c_mux_value);
+	*mux = rtl8196c_mux_value;
+	spin_unlock_irqrestore(&gpio_rtl8196c.lock, flags);
+	return 0;
+}
+
+#define param_check_rtl8196c_mux(a,b)  ;;
+
+////////////////////////////////////////////////////////////////////////
+//get current configured port value
+static int param_get_rtl8196c_mux( char *buf, struct kernel_param *kp )
+{
+	volatile uint32_t *mux = (uint32_t*)RTL8196C_MUX_ADDR;
+	unsigned long flags;
+	
+	PRINT("param_get_rtl8196c_mux\n");
+	spin_lock_irqsave(&gpio_rtl8196c.lock, flags);
+	sprintf( buf, "0x%x", *mux );
+	spin_unlock_irqrestore(&gpio_rtl8196c.lock, flags);
+	return strlen( buf );
+}
+
+module_param_named(rtl8196c_mux, g_muxdummy, rtl8196c_mux, S_IRUGO | S_IWUSR);
+
+////////////////////////////////////////////////////////////////////////
+static int gpio_rtl8196c_dir_in( struct gpio_chip *chip, unsigned int gpio )
+{
+	volatile uint32_t *dir = (uint32_t*)RTL8196C_GPIO_PABCD_DIR_ADDR;
+	unsigned long flags;
+	struct rtl_gpio_chip *rgc = to_rtl_gpio_chip( chip );
+	
+	PRINT("gpio_rtl8196c_dir_in\n");
+	PRINT("offset = %d\n", gpio);
+	
+	spin_lock_irqsave(rgc->lock, flags);
+	rgc->gpio_dir &= ~(1 << gpio);
+	*dir = rgc->gpio_dir;
+	spin_unlock_irqrestore(rgc->lock, flags);
+	
+	return 0;
+}
+
+
+////////////////////////////////////////////////////////////////////////
+static int gpio_rtl8196c_dir_out( struct gpio_chip *chip, unsigned int gpio )
+{
+	volatile uint32_t *dir = (uint32_t*)RTL8196C_GPIO_PABCD_DIR_ADDR;
+	unsigned long flags;
+	struct rtl_gpio_chip *rgc = to_rtl_gpio_chip( chip );
+	
+	PRINT("gpio_rtl8196c_dir_out\n");
+	PRINT("offset = %d\n", gpio);
+	
+	spin_lock_irqsave(rgc->lock, flags);
+	rgc->gpio_dir |= (1 << gpio);
+	*dir = rgc->gpio_dir;
+	spin_unlock_irqrestore(rgc->lock, flags);
+	
+	return 0;
+}
+
+
+////////////////////////////////////////////////////////////////////////
+static int gpio_rtl8196c_get( struct gpio_chip *chip, unsigned int gpio )
+{
+	volatile uint32_t *dat = (uint32_t*)RTL8196C_GPIO_PABCD_DAT_ADDR;
+	int res=0;
+	unsigned long flags;
+	struct rtl_gpio_chip *rgc = to_rtl_gpio_chip( chip );
+	
+	PRINT("gpio_rtl8196c_get\n");
+	PRINT("offset = %d\n", gpio);
+	
+	spin_lock_irqsave(rgc->lock, flags);
+	//or get it from data register?
+	res = ((*dat)>>gpio)&0x1;
+	spin_unlock_irqrestore(rgc->lock, flags);
+	return res;
+}
+
+
+////////////////////////////////////////////////////////////////////////
+static void gpio_rtl8196c_set( struct gpio_chip *chip, unsigned int gpio, int value )
+{
+	volatile uint32_t *dat = (uint32_t*)RTL8196C_GPIO_PABCD_DAT_ADDR;
+	int res=0;
+	unsigned long flags;
+	struct rtl_gpio_chip *rgc = to_rtl_gpio_chip( chip );
+	
+	PRINT("gpio_rtl8196c_set\n");
+	PRINT("offset = %d = %d\n", gpio, value);
+	
+	spin_lock_irqsave(rgc->lock, flags);
+	if ( value )
+		rgc->gpio_data |= (1 << gpio);
+	else
+		rgc->gpio_data &= ~(1 << gpio);
+	*dat = rgc->gpio_data;
+	spin_unlock_irqrestore(rgc->lock, flags);
+	
+}
+
+////////////////////////////////////////////////////////////////////////
+//init module
+struct rtl_gpio_chip gpio_rtl8196c = 
+{
+	.chip = {
+		.label =		"gpio_rtl8196c",
+		.direction_input =	gpio_rtl8196c_dir_in,
+		.get =			gpio_rtl8196c_get,
+		.direction_output =	gpio_rtl8196c_dir_out,
+		.set =			gpio_rtl8196c_set,
+		.base =			0,
+		.ngpio =		32,
+	},
+	.gpio_dir = 0x0,
+};
+
+static int __init gpio_rtl8196c_init( void )
+{
+	PRINT("Start\n");
+	gpiochip_add( &gpio_rtl8196c.chip );
+	return 0;
+}
+
+////////////////////////////////////////////////////////////////////////
+//exit from module
+static int gpio_rtl8196c_exit( void )
+{
+	PRINT("End\n");
+	gpiochip_remove( &gpio_rtl8196c.chip );
+	return 0;
+}
+
+
+
+MODULE_AUTHOR("Artur Artamonov");
+MODULE_DESCRIPTION("gpio_rtl8196c");
+MODULE_LICENSE("GPL");
+
+module_init( gpio_rtl8196c_init );
+module_exit( gpio_rtl8196c_exit );