#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/sizes.h>
#include <linux/brcmstb/brcmstb.h>
#include <linux/brcmstb/gpio_api.h>

#define GIO_BANK_SIZE	0x20
#define GPIO_PER_BANK	32

static int test_gpio_bank(uint32_t offset, unsigned int width)
{
	unsigned int shift, bank, banks;
	int ret;

	banks = width / GIO_BANK_SIZE;

	pr_info("Testing controller at 0x%08x, width: 0x%08x banks: %d\n",
		offset, width, banks);

	for (bank = 0; bank < banks; bank++) {
		for (shift = 0; shift < 32; shift++) {
			ret = brcmstb_gpio_irq(offset + bank * GIO_BANK_SIZE,
					       shift);
			if (ret < 0)
				continue;

			pr_info("%s: GPIO%d -> IRQ%d\n",
				__func__, shift + bank * GPIO_PER_BANK, ret);
		}
	}

	return 0;
}

static int __init test_init(void)
{
	unsigned int times;
	int ret;

	for (times = 0; times < 2; times++) {
		ret = test_gpio_bank(BCHP_GIO_REG_START,
				     BCHP_GIO_REG_END - BCHP_GIO_REG_START + 4);
		if (ret)
			pr_err("%s: GIO_REG_START failed!\n", __func__);

		ret = test_gpio_bank(BCHP_GIO_AON_REG_START,
				     BCHP_GIO_AON_REG_END - BCHP_GIO_AON_REG_START + 4);
		if (ret)
			pr_err("%s: GIO_AON_REG_START failed!\n", __func__);
	}

	return 0;
}

static void __exit test_exit(void)
{
}

module_init(test_init);
module_exit(test_exit);
MODULE_LICENSE("GPL");
MODULE_AUTHOR("Florian Fainelli (Broadcom Corporation)");