1 /* drivers/misc/timed_gpio.c
3 * Copyright (C) 2008 Google, Inc.
4 * Author: Mike Lockwood <lockwood@android.com>
6 * This software is licensed under the terms of the GNU General Public
7 * License version 2, as published by the Free Software Foundation, and
8 * may be copied, distributed, and modified under those terms.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
17 #include <linux/module.h>
18 #include <linux/platform_device.h>
19 #include <linux/slab.h>
20 #include <linux/hrtimer.h>
21 #include <linux/err.h>
22 #include <linux/gpio.h>
23 #include <linux/ktime.h>
25 #include "timed_output.h"
26 #include "timed_gpio.h"
29 struct timed_gpio_data
{
30 struct timed_output_dev dev
;
38 static enum hrtimer_restart
gpio_timer_func(struct hrtimer
*timer
)
40 struct timed_gpio_data
*data
=
41 container_of(timer
, struct timed_gpio_data
, timer
);
43 gpio_direction_output(data
->gpio
, data
->active_low
? 1 : 0);
44 return HRTIMER_NORESTART
;
47 static int gpio_get_time(struct timed_output_dev
*dev
)
49 struct timed_gpio_data
*data
;
52 data
= container_of(dev
, struct timed_gpio_data
, dev
);
54 if (!hrtimer_active(&data
->timer
))
57 t
= hrtimer_get_remaining(&data
->timer
);
59 return ktime_to_ms(t
);
62 static void gpio_enable(struct timed_output_dev
*dev
, int value
)
64 struct timed_gpio_data
*data
=
65 container_of(dev
, struct timed_gpio_data
, dev
);
68 spin_lock_irqsave(&data
->lock
, flags
);
70 /* cancel previous timer and set GPIO according to value */
71 hrtimer_cancel(&data
->timer
);
72 gpio_direction_output(data
->gpio
, data
->active_low
? !value
: !!value
);
75 if (value
> data
->max_timeout
)
76 value
= data
->max_timeout
;
78 hrtimer_start(&data
->timer
,
79 ktime_set(value
/ 1000, (value
% 1000) * 1000000),
83 spin_unlock_irqrestore(&data
->lock
, flags
);
86 static int timed_gpio_probe(struct platform_device
*pdev
)
88 struct timed_gpio_platform_data
*pdata
= pdev
->dev
.platform_data
;
89 struct timed_gpio
*cur_gpio
;
90 struct timed_gpio_data
*gpio_data
, *gpio_dat
;
96 gpio_data
= devm_kzalloc(&pdev
->dev
,
97 sizeof(struct timed_gpio_data
) * pdata
->num_gpios
,
102 for (i
= 0; i
< pdata
->num_gpios
; i
++) {
103 cur_gpio
= &pdata
->gpios
[i
];
104 gpio_dat
= &gpio_data
[i
];
106 hrtimer_init(&gpio_dat
->timer
, CLOCK_MONOTONIC
,
108 gpio_dat
->timer
.function
= gpio_timer_func
;
109 spin_lock_init(&gpio_dat
->lock
);
111 gpio_dat
->dev
.name
= cur_gpio
->name
;
112 gpio_dat
->dev
.get_time
= gpio_get_time
;
113 gpio_dat
->dev
.enable
= gpio_enable
;
114 ret
= gpio_request(cur_gpio
->gpio
, cur_gpio
->name
);
117 ret
= timed_output_dev_register(&gpio_dat
->dev
);
119 gpio_free(cur_gpio
->gpio
);
123 gpio_dat
->gpio
= cur_gpio
->gpio
;
124 gpio_dat
->max_timeout
= cur_gpio
->max_timeout
;
125 gpio_dat
->active_low
= cur_gpio
->active_low
;
126 gpio_direction_output(gpio_dat
->gpio
, gpio_dat
->active_low
);
129 platform_set_drvdata(pdev
, gpio_data
);
135 timed_output_dev_unregister(&gpio_data
[i
].dev
);
136 gpio_free(gpio_data
[i
].gpio
);
142 static int timed_gpio_remove(struct platform_device
*pdev
)
144 struct timed_gpio_platform_data
*pdata
= pdev
->dev
.platform_data
;
145 struct timed_gpio_data
*gpio_data
= platform_get_drvdata(pdev
);
148 for (i
= 0; i
< pdata
->num_gpios
; i
++) {
149 timed_output_dev_unregister(&gpio_data
[i
].dev
);
150 gpio_free(gpio_data
[i
].gpio
);
156 static struct platform_driver timed_gpio_driver
= {
157 .probe
= timed_gpio_probe
,
158 .remove
= timed_gpio_remove
,
160 .name
= TIMED_GPIO_NAME
,
164 module_platform_driver(timed_gpio_driver
);
166 MODULE_AUTHOR("Mike Lockwood <lockwood@android.com>");
167 MODULE_DESCRIPTION("timed gpio driver");
168 MODULE_LICENSE("GPL");