162306a36Sopenharmony_ci/*
262306a36Sopenharmony_ci * This file is subject to the terms and conditions of the GNU General Public
362306a36Sopenharmony_ci * License.  See the file "COPYING" in the main directory of this archive
462306a36Sopenharmony_ci * for more details.
562306a36Sopenharmony_ci *
662306a36Sopenharmony_ci * Copyright (C) 2011, 2012 Cavium Inc.
762306a36Sopenharmony_ci */
862306a36Sopenharmony_ci
962306a36Sopenharmony_ci#include <linux/platform_device.h>
1062306a36Sopenharmony_ci#include <linux/kernel.h>
1162306a36Sopenharmony_ci#include <linux/module.h>
1262306a36Sopenharmony_ci#include <linux/gpio/driver.h>
1362306a36Sopenharmony_ci#include <linux/io.h>
1462306a36Sopenharmony_ci
1562306a36Sopenharmony_ci#include <asm/octeon/octeon.h>
1662306a36Sopenharmony_ci#include <asm/octeon/cvmx-gpio-defs.h>
1762306a36Sopenharmony_ci
1862306a36Sopenharmony_ci#define RX_DAT 0x80
1962306a36Sopenharmony_ci#define TX_SET 0x88
2062306a36Sopenharmony_ci#define TX_CLEAR 0x90
2162306a36Sopenharmony_ci/*
2262306a36Sopenharmony_ci * The address offset of the GPIO configuration register for a given
2362306a36Sopenharmony_ci * line.
2462306a36Sopenharmony_ci */
2562306a36Sopenharmony_cistatic unsigned int bit_cfg_reg(unsigned int offset)
2662306a36Sopenharmony_ci{
2762306a36Sopenharmony_ci	/*
2862306a36Sopenharmony_ci	 * The register stride is 8, with a discontinuity after the
2962306a36Sopenharmony_ci	 * first 16.
3062306a36Sopenharmony_ci	 */
3162306a36Sopenharmony_ci	if (offset < 16)
3262306a36Sopenharmony_ci		return 8 * offset;
3362306a36Sopenharmony_ci	else
3462306a36Sopenharmony_ci		return 8 * (offset - 16) + 0x100;
3562306a36Sopenharmony_ci}
3662306a36Sopenharmony_ci
3762306a36Sopenharmony_cistruct octeon_gpio {
3862306a36Sopenharmony_ci	struct gpio_chip chip;
3962306a36Sopenharmony_ci	u64 register_base;
4062306a36Sopenharmony_ci};
4162306a36Sopenharmony_ci
4262306a36Sopenharmony_cistatic int octeon_gpio_dir_in(struct gpio_chip *chip, unsigned offset)
4362306a36Sopenharmony_ci{
4462306a36Sopenharmony_ci	struct octeon_gpio *gpio = gpiochip_get_data(chip);
4562306a36Sopenharmony_ci
4662306a36Sopenharmony_ci	cvmx_write_csr(gpio->register_base + bit_cfg_reg(offset), 0);
4762306a36Sopenharmony_ci	return 0;
4862306a36Sopenharmony_ci}
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_cistatic void octeon_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
5162306a36Sopenharmony_ci{
5262306a36Sopenharmony_ci	struct octeon_gpio *gpio = gpiochip_get_data(chip);
5362306a36Sopenharmony_ci	u64 mask = 1ull << offset;
5462306a36Sopenharmony_ci	u64 reg = gpio->register_base + (value ? TX_SET : TX_CLEAR);
5562306a36Sopenharmony_ci	cvmx_write_csr(reg, mask);
5662306a36Sopenharmony_ci}
5762306a36Sopenharmony_ci
5862306a36Sopenharmony_cistatic int octeon_gpio_dir_out(struct gpio_chip *chip, unsigned offset,
5962306a36Sopenharmony_ci			       int value)
6062306a36Sopenharmony_ci{
6162306a36Sopenharmony_ci	struct octeon_gpio *gpio = gpiochip_get_data(chip);
6262306a36Sopenharmony_ci	union cvmx_gpio_bit_cfgx cfgx;
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_ci	octeon_gpio_set(chip, offset, value);
6562306a36Sopenharmony_ci
6662306a36Sopenharmony_ci	cfgx.u64 = 0;
6762306a36Sopenharmony_ci	cfgx.s.tx_oe = 1;
6862306a36Sopenharmony_ci
6962306a36Sopenharmony_ci	cvmx_write_csr(gpio->register_base + bit_cfg_reg(offset), cfgx.u64);
7062306a36Sopenharmony_ci	return 0;
7162306a36Sopenharmony_ci}
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_cistatic int octeon_gpio_get(struct gpio_chip *chip, unsigned offset)
7462306a36Sopenharmony_ci{
7562306a36Sopenharmony_ci	struct octeon_gpio *gpio = gpiochip_get_data(chip);
7662306a36Sopenharmony_ci	u64 read_bits = cvmx_read_csr(gpio->register_base + RX_DAT);
7762306a36Sopenharmony_ci
7862306a36Sopenharmony_ci	return ((1ull << offset) & read_bits) != 0;
7962306a36Sopenharmony_ci}
8062306a36Sopenharmony_ci
8162306a36Sopenharmony_cistatic int octeon_gpio_probe(struct platform_device *pdev)
8262306a36Sopenharmony_ci{
8362306a36Sopenharmony_ci	struct octeon_gpio *gpio;
8462306a36Sopenharmony_ci	struct gpio_chip *chip;
8562306a36Sopenharmony_ci	void __iomem *reg_base;
8662306a36Sopenharmony_ci	int err = 0;
8762306a36Sopenharmony_ci
8862306a36Sopenharmony_ci	gpio = devm_kzalloc(&pdev->dev, sizeof(*gpio), GFP_KERNEL);
8962306a36Sopenharmony_ci	if (!gpio)
9062306a36Sopenharmony_ci		return -ENOMEM;
9162306a36Sopenharmony_ci	chip = &gpio->chip;
9262306a36Sopenharmony_ci
9362306a36Sopenharmony_ci	reg_base = devm_platform_ioremap_resource(pdev, 0);
9462306a36Sopenharmony_ci	if (IS_ERR(reg_base))
9562306a36Sopenharmony_ci		return PTR_ERR(reg_base);
9662306a36Sopenharmony_ci
9762306a36Sopenharmony_ci	gpio->register_base = (u64)reg_base;
9862306a36Sopenharmony_ci	pdev->dev.platform_data = chip;
9962306a36Sopenharmony_ci	chip->label = "octeon-gpio";
10062306a36Sopenharmony_ci	chip->parent = &pdev->dev;
10162306a36Sopenharmony_ci	chip->owner = THIS_MODULE;
10262306a36Sopenharmony_ci	chip->base = 0;
10362306a36Sopenharmony_ci	chip->can_sleep = false;
10462306a36Sopenharmony_ci	chip->ngpio = 20;
10562306a36Sopenharmony_ci	chip->direction_input = octeon_gpio_dir_in;
10662306a36Sopenharmony_ci	chip->get = octeon_gpio_get;
10762306a36Sopenharmony_ci	chip->direction_output = octeon_gpio_dir_out;
10862306a36Sopenharmony_ci	chip->set = octeon_gpio_set;
10962306a36Sopenharmony_ci	err = devm_gpiochip_add_data(&pdev->dev, chip, gpio);
11062306a36Sopenharmony_ci	if (err)
11162306a36Sopenharmony_ci		return err;
11262306a36Sopenharmony_ci
11362306a36Sopenharmony_ci	dev_info(&pdev->dev, "OCTEON GPIO driver probed.\n");
11462306a36Sopenharmony_ci	return 0;
11562306a36Sopenharmony_ci}
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_cistatic const struct of_device_id octeon_gpio_match[] = {
11862306a36Sopenharmony_ci	{
11962306a36Sopenharmony_ci		.compatible = "cavium,octeon-3860-gpio",
12062306a36Sopenharmony_ci	},
12162306a36Sopenharmony_ci	{},
12262306a36Sopenharmony_ci};
12362306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, octeon_gpio_match);
12462306a36Sopenharmony_ci
12562306a36Sopenharmony_cistatic struct platform_driver octeon_gpio_driver = {
12662306a36Sopenharmony_ci	.driver = {
12762306a36Sopenharmony_ci		.name		= "octeon_gpio",
12862306a36Sopenharmony_ci		.of_match_table = octeon_gpio_match,
12962306a36Sopenharmony_ci	},
13062306a36Sopenharmony_ci	.probe		= octeon_gpio_probe,
13162306a36Sopenharmony_ci};
13262306a36Sopenharmony_ci
13362306a36Sopenharmony_cimodule_platform_driver(octeon_gpio_driver);
13462306a36Sopenharmony_ci
13562306a36Sopenharmony_ciMODULE_DESCRIPTION("Cavium Inc. OCTEON GPIO Driver");
13662306a36Sopenharmony_ciMODULE_AUTHOR("David Daney");
13762306a36Sopenharmony_ciMODULE_LICENSE("GPL");
138