Blame view
drivers/gpio/gpio-twl6040.c
3.26 KB
70ffd691f
|
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 |
/* * Access to GPOs on TWL6040 chip * * Copyright (C) 2012 Texas Instruments, Inc. * * Authors: * Sergio Aguirre <saaguirre@ti.com> * Peter Ujfalusi <peter.ujfalusi@ti.com> * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA */ #include <linux/module.h> #include <linux/init.h> #include <linux/kthread.h> #include <linux/irq.h> #include <linux/gpio.h> #include <linux/platform_device.h> #include <linux/of.h> #include <linux/mfd/twl6040.h> |
70ffd691f
|
34 35 |
static int twl6040gpo_get(struct gpio_chip *chip, unsigned offset) { |
58383c784
|
36 |
struct twl6040 *twl6040 = dev_get_drvdata(chip->parent->parent); |
70ffd691f
|
37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 |
int ret = 0; ret = twl6040_reg_read(twl6040, TWL6040_REG_GPOCTL); if (ret < 0) return ret; return (ret >> offset) & 1; } static int twl6040gpo_direction_out(struct gpio_chip *chip, unsigned offset, int value) { /* This only drives GPOs, and can't change direction */ return 0; } static void twl6040gpo_set(struct gpio_chip *chip, unsigned offset, int value) { |
58383c784
|
55 |
struct twl6040 *twl6040 = dev_get_drvdata(chip->parent->parent); |
70ffd691f
|
56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 |
int ret; u8 gpoctl; ret = twl6040_reg_read(twl6040, TWL6040_REG_GPOCTL); if (ret < 0) return; if (value) gpoctl = ret | (1 << offset); else gpoctl = ret & ~(1 << offset); twl6040_reg_write(twl6040, TWL6040_REG_GPOCTL, gpoctl); } static struct gpio_chip twl6040gpo_chip = { .label = "twl6040", .owner = THIS_MODULE, .get = twl6040gpo_get, .direction_output = twl6040gpo_direction_out, .set = twl6040gpo_set, |
9fb1f39eb
|
77 |
.can_sleep = true, |
70ffd691f
|
78 79 80 |
}; /*----------------------------------------------------------------------*/ |
3836309d9
|
81 |
static int gpo_twl6040_probe(struct platform_device *pdev) |
70ffd691f
|
82 |
{ |
70ffd691f
|
83 84 85 |
struct device *twl6040_core_dev = pdev->dev.parent; struct twl6040 *twl6040 = dev_get_drvdata(twl6040_core_dev); int ret; |
a5d28d79f
|
86 |
twl6040gpo_chip.base = -1; |
70ffd691f
|
87 88 89 90 91 |
if (twl6040_get_revid(twl6040) < TWL6041_REV_ES2_0) twl6040gpo_chip.ngpio = 3; /* twl6040 have 3 GPO */ else twl6040gpo_chip.ngpio = 1; /* twl6041 have 1 GPO */ |
58383c784
|
92 |
twl6040gpo_chip.parent = &pdev->dev; |
70ffd691f
|
93 94 95 |
#ifdef CONFIG_OF_GPIO twl6040gpo_chip.of_node = twl6040_core_dev->of_node; #endif |
fc0292a23
|
96 |
ret = devm_gpiochip_add_data(&pdev->dev, &twl6040gpo_chip, NULL); |
70ffd691f
|
97 98 99 100 101 102 103 104 |
if (ret < 0) { dev_err(&pdev->dev, "could not register gpiochip, %d ", ret); twl6040gpo_chip.ngpio = 0; } return ret; } |
70ffd691f
|
105 106 107 108 109 110 |
/* Note: this hardware lives inside an I2C-based multi-function device. */ MODULE_ALIAS("platform:twl6040-gpo"); static struct platform_driver gpo_twl6040_driver = { .driver = { .name = "twl6040-gpo", |
70ffd691f
|
111 112 |
}, .probe = gpo_twl6040_probe, |
70ffd691f
|
113 114 115 116 117 118 119 |
}; module_platform_driver(gpo_twl6040_driver); MODULE_AUTHOR("Texas Instruments, Inc."); MODULE_DESCRIPTION("GPO interface for TWL6040"); MODULE_LICENSE("GPL"); |