ir-rx51: use hrtimer instead of dmtimer

Drop dmtimer usage for pulse timer in favor of hrtimer. That allows
removing PWM dmitimer platform data usage.

Signed-off-by: Ivaylo Dimitrov <ivo.g.dimitrov.75@gmail.com>
Acked-by: Pali Rohár <pali.rohar@gmail.com>
Signed-off-by: Tony Lindgren <tony@atomide.com>
This commit is contained in:
Ivaylo Dimitrov 2016-06-22 22:22:21 +03:00 committed by Tony Lindgren
parent b540617698
commit 79cdad3635
4 changed files with 37 additions and 137 deletions

View File

@ -1242,10 +1242,6 @@ static struct pwm_omap_dmtimer_pdata __maybe_unused pwm_dmtimer_pdata = {
#if defined(CONFIG_IR_RX51) || defined(CONFIG_IR_RX51_MODULE) #if defined(CONFIG_IR_RX51) || defined(CONFIG_IR_RX51_MODULE)
static struct lirc_rx51_platform_data rx51_lirc_data = { static struct lirc_rx51_platform_data rx51_lirc_data = {
.set_max_mpu_wakeup_lat = omap_pm_set_max_mpu_wakeup_lat, .set_max_mpu_wakeup_lat = omap_pm_set_max_mpu_wakeup_lat,
#if IS_ENABLED(CONFIG_OMAP_DM_TIMER)
.dmtimer = &pwm_dmtimer_pdata,
#endif
}; };
static struct platform_device rx51_lirc_device = { static struct platform_device rx51_lirc_device = {

View File

@ -486,9 +486,6 @@ static struct pwm_omap_dmtimer_pdata pwm_dmtimer_pdata = {
static struct lirc_rx51_platform_data __maybe_unused rx51_lirc_data = { static struct lirc_rx51_platform_data __maybe_unused rx51_lirc_data = {
.set_max_mpu_wakeup_lat = omap_pm_set_max_mpu_wakeup_lat, .set_max_mpu_wakeup_lat = omap_pm_set_max_mpu_wakeup_lat,
#if IS_ENABLED(CONFIG_OMAP_DM_TIMER)
.dmtimer = &pwm_dmtimer_pdata,
#endif
}; };
static struct platform_device __maybe_unused rx51_lirc_device = { static struct platform_device __maybe_unused rx51_lirc_device = {

View File

@ -22,10 +22,10 @@
#include <linux/wait.h> #include <linux/wait.h>
#include <linux/pwm.h> #include <linux/pwm.h>
#include <linux/of.h> #include <linux/of.h>
#include <linux/hrtimer.h>
#include <media/lirc.h> #include <media/lirc.h>
#include <media/lirc_dev.h> #include <media/lirc_dev.h>
#include <linux/platform_data/pwm_omap_dmtimer.h>
#include <linux/platform_data/media/ir-rx51.h> #include <linux/platform_data/media/ir-rx51.h>
#define LIRC_RX51_DRIVER_FEATURES (LIRC_CAN_SET_SEND_DUTY_CYCLE | \ #define LIRC_RX51_DRIVER_FEATURES (LIRC_CAN_SET_SEND_DUTY_CYCLE | \
@ -36,32 +36,26 @@
#define WBUF_LEN 256 #define WBUF_LEN 256
#define TIMER_MAX_VALUE 0xffffffff
struct lirc_rx51 { struct lirc_rx51 {
struct pwm_device *pwm; struct pwm_device *pwm;
pwm_omap_dmtimer *pulse_timer; struct hrtimer timer;
struct pwm_omap_dmtimer_pdata *dmtimer;
struct device *dev; struct device *dev;
struct lirc_rx51_platform_data *pdata; struct lirc_rx51_platform_data *pdata;
wait_queue_head_t wqueue; wait_queue_head_t wqueue;
unsigned long fclk_khz;
unsigned int freq; /* carrier frequency */ unsigned int freq; /* carrier frequency */
unsigned int duty_cycle; /* carrier duty cycle */ unsigned int duty_cycle; /* carrier duty cycle */
unsigned int irq_num;
unsigned int match;
int wbuf[WBUF_LEN]; int wbuf[WBUF_LEN];
int wbuf_index; int wbuf_index;
unsigned long device_is_open; unsigned long device_is_open;
}; };
static void lirc_rx51_on(struct lirc_rx51 *lirc_rx51) static inline void lirc_rx51_on(struct lirc_rx51 *lirc_rx51)
{ {
pwm_enable(lirc_rx51->pwm); pwm_enable(lirc_rx51->pwm);
} }
static void lirc_rx51_off(struct lirc_rx51 *lirc_rx51) static inline void lirc_rx51_off(struct lirc_rx51 *lirc_rx51)
{ {
pwm_disable(lirc_rx51->pwm); pwm_disable(lirc_rx51->pwm);
} }
@ -72,61 +66,21 @@ static int init_timing_params(struct lirc_rx51 *lirc_rx51)
int duty, period = DIV_ROUND_CLOSEST(NSEC_PER_SEC, lirc_rx51->freq); int duty, period = DIV_ROUND_CLOSEST(NSEC_PER_SEC, lirc_rx51->freq);
duty = DIV_ROUND_CLOSEST(lirc_rx51->duty_cycle * period, 100); duty = DIV_ROUND_CLOSEST(lirc_rx51->duty_cycle * period, 100);
lirc_rx51->dmtimer->set_int_enable(lirc_rx51->pulse_timer, 0);
pwm_config(pwm, duty, period); pwm_config(pwm, duty, period);
lirc_rx51->dmtimer->start(lirc_rx51->pulse_timer);
lirc_rx51->match = 0;
return 0; return 0;
} }
#define tics_after(a, b) ((long)(b) - (long)(a) < 0) static enum hrtimer_restart lirc_rx51_timer_cb(struct hrtimer *timer)
static int pulse_timer_set_timeout(struct lirc_rx51 *lirc_rx51, int usec)
{ {
int counter; struct lirc_rx51 *lirc_rx51 =
container_of(timer, struct lirc_rx51, timer);
ktime_t now;
BUG_ON(usec < 0);
if (lirc_rx51->match == 0)
counter = lirc_rx51->dmtimer->read_counter(lirc_rx51->pulse_timer);
else
counter = lirc_rx51->match;
counter += (u32)(lirc_rx51->fclk_khz * usec / (1000));
lirc_rx51->dmtimer->set_match(lirc_rx51->pulse_timer, 1, counter);
lirc_rx51->dmtimer->set_int_enable(lirc_rx51->pulse_timer,
PWM_OMAP_DMTIMER_INT_MATCH);
if (tics_after(lirc_rx51->dmtimer->read_counter(lirc_rx51->pulse_timer),
counter)) {
return 1;
}
return 0;
}
static irqreturn_t lirc_rx51_interrupt_handler(int irq, void *ptr)
{
unsigned int retval;
struct lirc_rx51 *lirc_rx51 = ptr;
retval = lirc_rx51->dmtimer->read_status(lirc_rx51->pulse_timer);
if (!retval)
return IRQ_NONE;
if (retval & ~PWM_OMAP_DMTIMER_INT_MATCH)
dev_err_ratelimited(lirc_rx51->dev,
": Unexpected interrupt source: %x\n", retval);
lirc_rx51->dmtimer->write_status(lirc_rx51->pulse_timer,
PWM_OMAP_DMTIMER_INT_MATCH |
PWM_OMAP_DMTIMER_INT_OVERFLOW |
PWM_OMAP_DMTIMER_INT_CAPTURE);
if (lirc_rx51->wbuf_index < 0) { if (lirc_rx51->wbuf_index < 0) {
dev_err_ratelimited(lirc_rx51->dev, dev_err_ratelimited(lirc_rx51->dev,
": BUG wbuf_index has value of %i\n", "BUG wbuf_index has value of %i\n",
lirc_rx51->wbuf_index); lirc_rx51->wbuf_index);
goto end; goto end;
} }
@ -136,6 +90,8 @@ static irqreturn_t lirc_rx51_interrupt_handler(int irq, void *ptr)
* pulses until we catch up. * pulses until we catch up.
*/ */
do { do {
u64 ns;
if (lirc_rx51->wbuf_index >= WBUF_LEN) if (lirc_rx51->wbuf_index >= WBUF_LEN)
goto end; goto end;
if (lirc_rx51->wbuf[lirc_rx51->wbuf_index] == -1) if (lirc_rx51->wbuf[lirc_rx51->wbuf_index] == -1)
@ -146,80 +102,24 @@ static irqreturn_t lirc_rx51_interrupt_handler(int irq, void *ptr)
else else
lirc_rx51_on(lirc_rx51); lirc_rx51_on(lirc_rx51);
retval = pulse_timer_set_timeout(lirc_rx51, ns = 1000 * lirc_rx51->wbuf[lirc_rx51->wbuf_index];
lirc_rx51->wbuf[lirc_rx51->wbuf_index]); hrtimer_add_expires_ns(timer, ns);
lirc_rx51->wbuf_index++; lirc_rx51->wbuf_index++;
} while (retval); now = timer->base->get_time();
return IRQ_HANDLED; } while (hrtimer_get_expires_tv64(timer) < now.tv64);
return HRTIMER_RESTART;
end: end:
/* Stop TX here */ /* Stop TX here */
lirc_rx51_off(lirc_rx51); lirc_rx51_off(lirc_rx51);
lirc_rx51->wbuf_index = -1; lirc_rx51->wbuf_index = -1;
lirc_rx51->dmtimer->stop(lirc_rx51->pulse_timer);
lirc_rx51->dmtimer->set_int_enable(lirc_rx51->pulse_timer, 0);
wake_up_interruptible(&lirc_rx51->wqueue); wake_up_interruptible(&lirc_rx51->wqueue);
return IRQ_HANDLED; return HRTIMER_NORESTART;
}
static int lirc_rx51_init_port(struct lirc_rx51 *lirc_rx51)
{
struct clk *clk_fclk;
int retval;
lirc_rx51->pwm = pwm_get(lirc_rx51->dev, NULL);
if (IS_ERR(lirc_rx51->pwm)) {
retval = PTR_ERR(lirc_rx51->pwm);
dev_err(lirc_rx51->dev, ": pwm_get failed: %d\n", retval);
return retval;
}
lirc_rx51->pulse_timer = lirc_rx51->dmtimer->request();
if (lirc_rx51->pulse_timer == NULL) {
dev_err(lirc_rx51->dev, ": Error requesting pulse timer\n");
retval = -EBUSY;
goto err1;
}
lirc_rx51->dmtimer->set_source(lirc_rx51->pulse_timer,
PWM_OMAP_DMTIMER_SRC_SYS_CLK);
lirc_rx51->dmtimer->enable(lirc_rx51->pulse_timer);
lirc_rx51->irq_num =
lirc_rx51->dmtimer->get_irq(lirc_rx51->pulse_timer);
retval = request_irq(lirc_rx51->irq_num, lirc_rx51_interrupt_handler,
IRQF_SHARED, "lirc_pulse_timer", lirc_rx51);
if (retval) {
dev_err(lirc_rx51->dev, ": Failed to request interrupt line\n");
goto err2;
}
clk_fclk = lirc_rx51->dmtimer->get_fclk(lirc_rx51->pulse_timer);
lirc_rx51->fclk_khz = clk_get_rate(clk_fclk) / 1000;
return 0;
err2:
lirc_rx51->dmtimer->free(lirc_rx51->pulse_timer);
err1:
pwm_put(lirc_rx51->pwm);
return retval;
}
static int lirc_rx51_free_port(struct lirc_rx51 *lirc_rx51)
{
lirc_rx51->dmtimer->set_int_enable(lirc_rx51->pulse_timer, 0);
free_irq(lirc_rx51->irq_num, lirc_rx51);
lirc_rx51_off(lirc_rx51);
lirc_rx51->dmtimer->disable(lirc_rx51->pulse_timer);
lirc_rx51->dmtimer->free(lirc_rx51->pulse_timer);
lirc_rx51->wbuf_index = -1;
pwm_put(lirc_rx51->pwm);
return 0;
} }
static ssize_t lirc_rx51_write(struct file *file, const char *buf, static ssize_t lirc_rx51_write(struct file *file, const char *buf,
@ -258,8 +158,9 @@ static ssize_t lirc_rx51_write(struct file *file, const char *buf,
lirc_rx51_on(lirc_rx51); lirc_rx51_on(lirc_rx51);
lirc_rx51->wbuf_index = 1; lirc_rx51->wbuf_index = 1;
pulse_timer_set_timeout(lirc_rx51, lirc_rx51->wbuf[0]); hrtimer_start(&lirc_rx51->timer,
ns_to_ktime(1000 * lirc_rx51->wbuf[0]),
HRTIMER_MODE_REL);
/* /*
* Don't return back to the userspace until the transfer has * Don't return back to the userspace until the transfer has
* finished * finished
@ -359,14 +260,24 @@ static int lirc_rx51_open(struct inode *inode, struct file *file)
if (test_and_set_bit(1, &lirc_rx51->device_is_open)) if (test_and_set_bit(1, &lirc_rx51->device_is_open))
return -EBUSY; return -EBUSY;
return lirc_rx51_init_port(lirc_rx51); lirc_rx51->pwm = pwm_get(lirc_rx51->dev, NULL);
if (IS_ERR(lirc_rx51->pwm)) {
int res = PTR_ERR(lirc_rx51->pwm);
dev_err(lirc_rx51->dev, "pwm_get failed: %d\n", res);
return res;
}
return 0;
} }
static int lirc_rx51_release(struct inode *inode, struct file *file) static int lirc_rx51_release(struct inode *inode, struct file *file)
{ {
struct lirc_rx51 *lirc_rx51 = file->private_data; struct lirc_rx51 *lirc_rx51 = file->private_data;
lirc_rx51_free_port(lirc_rx51); hrtimer_cancel(&lirc_rx51->timer);
lirc_rx51_off(lirc_rx51);
pwm_put(lirc_rx51->pwm);
clear_bit(1, &lirc_rx51->device_is_open); clear_bit(1, &lirc_rx51->device_is_open);
@ -441,11 +352,6 @@ static int lirc_rx51_probe(struct platform_device *dev)
return -ENXIO; return -ENXIO;
} }
if (!lirc_rx51.pdata->dmtimer) {
dev_err(&dev->dev, "no dmtimer?\n");
return -ENODEV;
}
pwm = pwm_get(&dev->dev, NULL); pwm = pwm_get(&dev->dev, NULL);
if (IS_ERR(pwm)) { if (IS_ERR(pwm)) {
int err = PTR_ERR(pwm); int err = PTR_ERR(pwm);
@ -459,7 +365,9 @@ static int lirc_rx51_probe(struct platform_device *dev)
lirc_rx51.freq = DIV_ROUND_CLOSEST(pwm_get_period(pwm), NSEC_PER_SEC); lirc_rx51.freq = DIV_ROUND_CLOSEST(pwm_get_period(pwm), NSEC_PER_SEC);
pwm_put(pwm); pwm_put(pwm);
lirc_rx51.dmtimer = lirc_rx51.pdata->dmtimer; hrtimer_init(&lirc_rx51.timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
lirc_rx51.timer.function = lirc_rx51_timer_cb;
lirc_rx51.dev = &dev->dev; lirc_rx51.dev = &dev->dev;
lirc_rx51_driver.dev = &dev->dev; lirc_rx51_driver.dev = &dev->dev;
lirc_rx51_driver.minor = lirc_register_driver(&lirc_rx51_driver); lirc_rx51_driver.minor = lirc_register_driver(&lirc_rx51_driver);

View File

@ -3,7 +3,6 @@
struct lirc_rx51_platform_data { struct lirc_rx51_platform_data {
int(*set_max_mpu_wakeup_lat)(struct device *dev, long t); int(*set_max_mpu_wakeup_lat)(struct device *dev, long t);
struct pwm_omap_dmtimer_pdata *dmtimer;
}; };
#endif #endif