162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Janz MODULbus VMOD-TTL GPIO Driver 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (c) 2010 Ira W. Snyder <iws@ovro.caltech.edu> 662306a36Sopenharmony_ci */ 762306a36Sopenharmony_ci 862306a36Sopenharmony_ci#include <linux/kernel.h> 962306a36Sopenharmony_ci#include <linux/module.h> 1062306a36Sopenharmony_ci#include <linux/init.h> 1162306a36Sopenharmony_ci#include <linux/interrupt.h> 1262306a36Sopenharmony_ci#include <linux/delay.h> 1362306a36Sopenharmony_ci#include <linux/platform_device.h> 1462306a36Sopenharmony_ci#include <linux/io.h> 1562306a36Sopenharmony_ci#include <linux/gpio/driver.h> 1662306a36Sopenharmony_ci#include <linux/slab.h> 1762306a36Sopenharmony_ci#include <linux/bitops.h> 1862306a36Sopenharmony_ci 1962306a36Sopenharmony_ci#include <linux/mfd/janz.h> 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_ci#define DRV_NAME "janz-ttl" 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_ci#define PORTA_DIRECTION 0x23 2462306a36Sopenharmony_ci#define PORTB_DIRECTION 0x2B 2562306a36Sopenharmony_ci#define PORTC_DIRECTION 0x06 2662306a36Sopenharmony_ci#define PORTA_IOCTL 0x24 2762306a36Sopenharmony_ci#define PORTB_IOCTL 0x2C 2862306a36Sopenharmony_ci#define PORTC_IOCTL 0x07 2962306a36Sopenharmony_ci 3062306a36Sopenharmony_ci#define MASTER_INT_CTL 0x00 3162306a36Sopenharmony_ci#define MASTER_CONF_CTL 0x01 3262306a36Sopenharmony_ci 3362306a36Sopenharmony_ci#define CONF_PAE BIT(2) 3462306a36Sopenharmony_ci#define CONF_PBE BIT(7) 3562306a36Sopenharmony_ci#define CONF_PCE BIT(4) 3662306a36Sopenharmony_ci 3762306a36Sopenharmony_cistruct ttl_control_regs { 3862306a36Sopenharmony_ci __be16 portc; 3962306a36Sopenharmony_ci __be16 portb; 4062306a36Sopenharmony_ci __be16 porta; 4162306a36Sopenharmony_ci __be16 control; 4262306a36Sopenharmony_ci}; 4362306a36Sopenharmony_ci 4462306a36Sopenharmony_cistruct ttl_module { 4562306a36Sopenharmony_ci struct gpio_chip gpio; 4662306a36Sopenharmony_ci 4762306a36Sopenharmony_ci /* base address of registers */ 4862306a36Sopenharmony_ci struct ttl_control_regs __iomem *regs; 4962306a36Sopenharmony_ci 5062306a36Sopenharmony_ci u8 portc_shadow; 5162306a36Sopenharmony_ci u8 portb_shadow; 5262306a36Sopenharmony_ci u8 porta_shadow; 5362306a36Sopenharmony_ci 5462306a36Sopenharmony_ci spinlock_t lock; 5562306a36Sopenharmony_ci}; 5662306a36Sopenharmony_ci 5762306a36Sopenharmony_cistatic int ttl_get_value(struct gpio_chip *gpio, unsigned offset) 5862306a36Sopenharmony_ci{ 5962306a36Sopenharmony_ci struct ttl_module *mod = dev_get_drvdata(gpio->parent); 6062306a36Sopenharmony_ci u8 *shadow; 6162306a36Sopenharmony_ci int ret; 6262306a36Sopenharmony_ci 6362306a36Sopenharmony_ci if (offset < 8) { 6462306a36Sopenharmony_ci shadow = &mod->porta_shadow; 6562306a36Sopenharmony_ci } else if (offset < 16) { 6662306a36Sopenharmony_ci shadow = &mod->portb_shadow; 6762306a36Sopenharmony_ci offset -= 8; 6862306a36Sopenharmony_ci } else { 6962306a36Sopenharmony_ci shadow = &mod->portc_shadow; 7062306a36Sopenharmony_ci offset -= 16; 7162306a36Sopenharmony_ci } 7262306a36Sopenharmony_ci 7362306a36Sopenharmony_ci spin_lock(&mod->lock); 7462306a36Sopenharmony_ci ret = *shadow & BIT(offset); 7562306a36Sopenharmony_ci spin_unlock(&mod->lock); 7662306a36Sopenharmony_ci return !!ret; 7762306a36Sopenharmony_ci} 7862306a36Sopenharmony_ci 7962306a36Sopenharmony_cistatic void ttl_set_value(struct gpio_chip *gpio, unsigned offset, int value) 8062306a36Sopenharmony_ci{ 8162306a36Sopenharmony_ci struct ttl_module *mod = dev_get_drvdata(gpio->parent); 8262306a36Sopenharmony_ci void __iomem *port; 8362306a36Sopenharmony_ci u8 *shadow; 8462306a36Sopenharmony_ci 8562306a36Sopenharmony_ci if (offset < 8) { 8662306a36Sopenharmony_ci port = &mod->regs->porta; 8762306a36Sopenharmony_ci shadow = &mod->porta_shadow; 8862306a36Sopenharmony_ci } else if (offset < 16) { 8962306a36Sopenharmony_ci port = &mod->regs->portb; 9062306a36Sopenharmony_ci shadow = &mod->portb_shadow; 9162306a36Sopenharmony_ci offset -= 8; 9262306a36Sopenharmony_ci } else { 9362306a36Sopenharmony_ci port = &mod->regs->portc; 9462306a36Sopenharmony_ci shadow = &mod->portc_shadow; 9562306a36Sopenharmony_ci offset -= 16; 9662306a36Sopenharmony_ci } 9762306a36Sopenharmony_ci 9862306a36Sopenharmony_ci spin_lock(&mod->lock); 9962306a36Sopenharmony_ci if (value) 10062306a36Sopenharmony_ci *shadow |= BIT(offset); 10162306a36Sopenharmony_ci else 10262306a36Sopenharmony_ci *shadow &= ~BIT(offset); 10362306a36Sopenharmony_ci 10462306a36Sopenharmony_ci iowrite16be(*shadow, port); 10562306a36Sopenharmony_ci spin_unlock(&mod->lock); 10662306a36Sopenharmony_ci} 10762306a36Sopenharmony_ci 10862306a36Sopenharmony_cistatic void ttl_write_reg(struct ttl_module *mod, u8 reg, u16 val) 10962306a36Sopenharmony_ci{ 11062306a36Sopenharmony_ci iowrite16be(reg, &mod->regs->control); 11162306a36Sopenharmony_ci iowrite16be(val, &mod->regs->control); 11262306a36Sopenharmony_ci} 11362306a36Sopenharmony_ci 11462306a36Sopenharmony_cistatic void ttl_setup_device(struct ttl_module *mod) 11562306a36Sopenharmony_ci{ 11662306a36Sopenharmony_ci /* reset the device to a known state */ 11762306a36Sopenharmony_ci iowrite16be(0x0000, &mod->regs->control); 11862306a36Sopenharmony_ci iowrite16be(0x0001, &mod->regs->control); 11962306a36Sopenharmony_ci iowrite16be(0x0000, &mod->regs->control); 12062306a36Sopenharmony_ci 12162306a36Sopenharmony_ci /* put all ports in open-drain mode */ 12262306a36Sopenharmony_ci ttl_write_reg(mod, PORTA_IOCTL, 0x00ff); 12362306a36Sopenharmony_ci ttl_write_reg(mod, PORTB_IOCTL, 0x00ff); 12462306a36Sopenharmony_ci ttl_write_reg(mod, PORTC_IOCTL, 0x000f); 12562306a36Sopenharmony_ci 12662306a36Sopenharmony_ci /* set all ports as outputs */ 12762306a36Sopenharmony_ci ttl_write_reg(mod, PORTA_DIRECTION, 0x0000); 12862306a36Sopenharmony_ci ttl_write_reg(mod, PORTB_DIRECTION, 0x0000); 12962306a36Sopenharmony_ci ttl_write_reg(mod, PORTC_DIRECTION, 0x0000); 13062306a36Sopenharmony_ci 13162306a36Sopenharmony_ci /* set all ports to drive zeroes */ 13262306a36Sopenharmony_ci iowrite16be(0x0000, &mod->regs->porta); 13362306a36Sopenharmony_ci iowrite16be(0x0000, &mod->regs->portb); 13462306a36Sopenharmony_ci iowrite16be(0x0000, &mod->regs->portc); 13562306a36Sopenharmony_ci 13662306a36Sopenharmony_ci /* enable all ports */ 13762306a36Sopenharmony_ci ttl_write_reg(mod, MASTER_CONF_CTL, CONF_PAE | CONF_PBE | CONF_PCE); 13862306a36Sopenharmony_ci} 13962306a36Sopenharmony_ci 14062306a36Sopenharmony_cistatic int ttl_probe(struct platform_device *pdev) 14162306a36Sopenharmony_ci{ 14262306a36Sopenharmony_ci struct janz_platform_data *pdata; 14362306a36Sopenharmony_ci struct ttl_module *mod; 14462306a36Sopenharmony_ci struct gpio_chip *gpio; 14562306a36Sopenharmony_ci int ret; 14662306a36Sopenharmony_ci 14762306a36Sopenharmony_ci pdata = dev_get_platdata(&pdev->dev); 14862306a36Sopenharmony_ci if (!pdata) { 14962306a36Sopenharmony_ci dev_err(&pdev->dev, "no platform data\n"); 15062306a36Sopenharmony_ci return -ENXIO; 15162306a36Sopenharmony_ci } 15262306a36Sopenharmony_ci 15362306a36Sopenharmony_ci mod = devm_kzalloc(&pdev->dev, sizeof(*mod), GFP_KERNEL); 15462306a36Sopenharmony_ci if (!mod) 15562306a36Sopenharmony_ci return -ENOMEM; 15662306a36Sopenharmony_ci 15762306a36Sopenharmony_ci platform_set_drvdata(pdev, mod); 15862306a36Sopenharmony_ci spin_lock_init(&mod->lock); 15962306a36Sopenharmony_ci 16062306a36Sopenharmony_ci /* get access to the MODULbus registers for this module */ 16162306a36Sopenharmony_ci mod->regs = devm_platform_ioremap_resource(pdev, 0); 16262306a36Sopenharmony_ci if (IS_ERR(mod->regs)) 16362306a36Sopenharmony_ci return PTR_ERR(mod->regs); 16462306a36Sopenharmony_ci 16562306a36Sopenharmony_ci ttl_setup_device(mod); 16662306a36Sopenharmony_ci 16762306a36Sopenharmony_ci /* Initialize the GPIO data structures */ 16862306a36Sopenharmony_ci gpio = &mod->gpio; 16962306a36Sopenharmony_ci gpio->parent = &pdev->dev; 17062306a36Sopenharmony_ci gpio->label = pdev->name; 17162306a36Sopenharmony_ci gpio->get = ttl_get_value; 17262306a36Sopenharmony_ci gpio->set = ttl_set_value; 17362306a36Sopenharmony_ci gpio->owner = THIS_MODULE; 17462306a36Sopenharmony_ci 17562306a36Sopenharmony_ci /* request dynamic allocation */ 17662306a36Sopenharmony_ci gpio->base = -1; 17762306a36Sopenharmony_ci gpio->ngpio = 20; 17862306a36Sopenharmony_ci 17962306a36Sopenharmony_ci ret = devm_gpiochip_add_data(&pdev->dev, gpio, NULL); 18062306a36Sopenharmony_ci if (ret) { 18162306a36Sopenharmony_ci dev_err(&pdev->dev, "unable to add GPIO chip\n"); 18262306a36Sopenharmony_ci return ret; 18362306a36Sopenharmony_ci } 18462306a36Sopenharmony_ci 18562306a36Sopenharmony_ci return 0; 18662306a36Sopenharmony_ci} 18762306a36Sopenharmony_ci 18862306a36Sopenharmony_cistatic struct platform_driver ttl_driver = { 18962306a36Sopenharmony_ci .driver = { 19062306a36Sopenharmony_ci .name = DRV_NAME, 19162306a36Sopenharmony_ci }, 19262306a36Sopenharmony_ci .probe = ttl_probe, 19362306a36Sopenharmony_ci}; 19462306a36Sopenharmony_ci 19562306a36Sopenharmony_cimodule_platform_driver(ttl_driver); 19662306a36Sopenharmony_ci 19762306a36Sopenharmony_ciMODULE_AUTHOR("Ira W. Snyder <iws@ovro.caltech.edu>"); 19862306a36Sopenharmony_ciMODULE_DESCRIPTION("Janz MODULbus VMOD-TTL Driver"); 19962306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 20062306a36Sopenharmony_ciMODULE_ALIAS("platform:janz-ttl"); 201