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