[Feature]add MT2731_MP2_MR2_SVN388 baseline version
Change-Id: Ief04314834b31e27effab435d3ca8ba33b499059
diff --git a/src/kernel/linux/v4.14/drivers/media/rc/ir-rx51.c b/src/kernel/linux/v4.14/drivers/media/rc/ir-rx51.c
new file mode 100644
index 0000000..49265f0
--- /dev/null
+++ b/src/kernel/linux/v4.14/drivers/media/rc/ir-rx51.c
@@ -0,0 +1,316 @@
+/*
+ * Copyright (C) 2008 Nokia Corporation
+ *
+ * Based on lirc_serial.c
+ *
+ * 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.
+ */
+#include <linux/clk.h>
+#include <linux/module.h>
+#include <linux/platform_device.h>
+#include <linux/wait.h>
+#include <linux/pwm.h>
+#include <linux/of.h>
+#include <linux/hrtimer.h>
+
+#include <media/rc-core.h>
+#include <linux/platform_data/media/ir-rx51.h>
+
+#define WBUF_LEN 256
+
+struct ir_rx51 {
+ struct rc_dev *rcdev;
+ struct pwm_device *pwm;
+ struct hrtimer timer;
+ struct device *dev;
+ struct ir_rx51_platform_data *pdata;
+ wait_queue_head_t wqueue;
+
+ unsigned int freq; /* carrier frequency */
+ unsigned int duty_cycle; /* carrier duty cycle */
+ int wbuf[WBUF_LEN];
+ int wbuf_index;
+ unsigned long device_is_open;
+};
+
+static inline void ir_rx51_on(struct ir_rx51 *ir_rx51)
+{
+ pwm_enable(ir_rx51->pwm);
+}
+
+static inline void ir_rx51_off(struct ir_rx51 *ir_rx51)
+{
+ pwm_disable(ir_rx51->pwm);
+}
+
+static int init_timing_params(struct ir_rx51 *ir_rx51)
+{
+ struct pwm_device *pwm = ir_rx51->pwm;
+ int duty, period = DIV_ROUND_CLOSEST(NSEC_PER_SEC, ir_rx51->freq);
+
+ duty = DIV_ROUND_CLOSEST(ir_rx51->duty_cycle * period, 100);
+
+ pwm_config(pwm, duty, period);
+
+ return 0;
+}
+
+static enum hrtimer_restart ir_rx51_timer_cb(struct hrtimer *timer)
+{
+ struct ir_rx51 *ir_rx51 = container_of(timer, struct ir_rx51, timer);
+ ktime_t now;
+
+ if (ir_rx51->wbuf_index < 0) {
+ dev_err_ratelimited(ir_rx51->dev,
+ "BUG wbuf_index has value of %i\n",
+ ir_rx51->wbuf_index);
+ goto end;
+ }
+
+ /*
+ * If we happen to hit an odd latency spike, loop through the
+ * pulses until we catch up.
+ */
+ do {
+ u64 ns;
+
+ if (ir_rx51->wbuf_index >= WBUF_LEN)
+ goto end;
+ if (ir_rx51->wbuf[ir_rx51->wbuf_index] == -1)
+ goto end;
+
+ if (ir_rx51->wbuf_index % 2)
+ ir_rx51_off(ir_rx51);
+ else
+ ir_rx51_on(ir_rx51);
+
+ ns = US_TO_NS(ir_rx51->wbuf[ir_rx51->wbuf_index]);
+ hrtimer_add_expires_ns(timer, ns);
+
+ ir_rx51->wbuf_index++;
+
+ now = timer->base->get_time();
+
+ } while (hrtimer_get_expires_tv64(timer) < now);
+
+ return HRTIMER_RESTART;
+end:
+ /* Stop TX here */
+ ir_rx51_off(ir_rx51);
+ ir_rx51->wbuf_index = -1;
+
+ wake_up_interruptible(&ir_rx51->wqueue);
+
+ return HRTIMER_NORESTART;
+}
+
+static int ir_rx51_tx(struct rc_dev *dev, unsigned int *buffer,
+ unsigned int count)
+{
+ struct ir_rx51 *ir_rx51 = dev->priv;
+
+ if (count > WBUF_LEN)
+ return -EINVAL;
+
+ memcpy(ir_rx51->wbuf, buffer, count * sizeof(unsigned int));
+
+ /* Wait any pending transfers to finish */
+ wait_event_interruptible(ir_rx51->wqueue, ir_rx51->wbuf_index < 0);
+
+ init_timing_params(ir_rx51);
+ if (count < WBUF_LEN)
+ ir_rx51->wbuf[count] = -1; /* Insert termination mark */
+
+ /*
+ * Adjust latency requirements so the device doesn't go in too
+ * deep sleep states
+ */
+ ir_rx51->pdata->set_max_mpu_wakeup_lat(ir_rx51->dev, 50);
+
+ ir_rx51_on(ir_rx51);
+ ir_rx51->wbuf_index = 1;
+ hrtimer_start(&ir_rx51->timer,
+ ns_to_ktime(US_TO_NS(ir_rx51->wbuf[0])),
+ HRTIMER_MODE_REL);
+ /*
+ * Don't return back to the userspace until the transfer has
+ * finished
+ */
+ wait_event_interruptible(ir_rx51->wqueue, ir_rx51->wbuf_index < 0);
+
+ /* We can sleep again */
+ ir_rx51->pdata->set_max_mpu_wakeup_lat(ir_rx51->dev, -1);
+
+ return count;
+}
+
+static int ir_rx51_open(struct rc_dev *dev)
+{
+ struct ir_rx51 *ir_rx51 = dev->priv;
+
+ if (test_and_set_bit(1, &ir_rx51->device_is_open))
+ return -EBUSY;
+
+ ir_rx51->pwm = pwm_get(ir_rx51->dev, NULL);
+ if (IS_ERR(ir_rx51->pwm)) {
+ int res = PTR_ERR(ir_rx51->pwm);
+
+ dev_err(ir_rx51->dev, "pwm_get failed: %d\n", res);
+ return res;
+ }
+
+ return 0;
+}
+
+static void ir_rx51_release(struct rc_dev *dev)
+{
+ struct ir_rx51 *ir_rx51 = dev->priv;
+
+ hrtimer_cancel(&ir_rx51->timer);
+ ir_rx51_off(ir_rx51);
+ pwm_put(ir_rx51->pwm);
+
+ clear_bit(1, &ir_rx51->device_is_open);
+}
+
+static struct ir_rx51 ir_rx51 = {
+ .duty_cycle = 50,
+ .wbuf_index = -1,
+};
+
+static int ir_rx51_set_duty_cycle(struct rc_dev *dev, u32 duty)
+{
+ struct ir_rx51 *ir_rx51 = dev->priv;
+
+ ir_rx51->duty_cycle = duty;
+
+ return 0;
+}
+
+static int ir_rx51_set_tx_carrier(struct rc_dev *dev, u32 carrier)
+{
+ struct ir_rx51 *ir_rx51 = dev->priv;
+
+ if (carrier > 500000 || carrier < 20000)
+ return -EINVAL;
+
+ ir_rx51->freq = carrier;
+
+ return 0;
+}
+
+#ifdef CONFIG_PM
+
+static int ir_rx51_suspend(struct platform_device *dev, pm_message_t state)
+{
+ /*
+ * In case the device is still open, do not suspend. Normally
+ * this should not be a problem as lircd only keeps the device
+ * open only for short periods of time. We also don't want to
+ * get involved with race conditions that might happen if we
+ * were in a middle of a transmit. Thus, we defer any suspend
+ * actions until transmit has completed.
+ */
+ if (test_and_set_bit(1, &ir_rx51.device_is_open))
+ return -EAGAIN;
+
+ clear_bit(1, &ir_rx51.device_is_open);
+
+ return 0;
+}
+
+static int ir_rx51_resume(struct platform_device *dev)
+{
+ return 0;
+}
+
+#else
+
+#define ir_rx51_suspend NULL
+#define ir_rx51_resume NULL
+
+#endif /* CONFIG_PM */
+
+static int ir_rx51_probe(struct platform_device *dev)
+{
+ struct pwm_device *pwm;
+ struct rc_dev *rcdev;
+
+ ir_rx51.pdata = dev->dev.platform_data;
+
+ if (!ir_rx51.pdata) {
+ dev_err(&dev->dev, "Platform Data is missing\n");
+ return -ENXIO;
+ }
+
+ pwm = pwm_get(&dev->dev, NULL);
+ if (IS_ERR(pwm)) {
+ int err = PTR_ERR(pwm);
+
+ if (err != -EPROBE_DEFER)
+ dev_err(&dev->dev, "pwm_get failed: %d\n", err);
+ return err;
+ }
+
+ /* Use default, in case userspace does not set the carrier */
+ ir_rx51.freq = DIV_ROUND_CLOSEST(pwm_get_period(pwm), NSEC_PER_SEC);
+ pwm_put(pwm);
+
+ hrtimer_init(&ir_rx51.timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
+ ir_rx51.timer.function = ir_rx51_timer_cb;
+
+ ir_rx51.dev = &dev->dev;
+
+ rcdev = devm_rc_allocate_device(&dev->dev, RC_DRIVER_IR_RAW_TX);
+ if (!rcdev)
+ return -ENOMEM;
+
+ rcdev->priv = &ir_rx51;
+ rcdev->open = ir_rx51_open;
+ rcdev->close = ir_rx51_release;
+ rcdev->tx_ir = ir_rx51_tx;
+ rcdev->s_tx_duty_cycle = ir_rx51_set_duty_cycle;
+ rcdev->s_tx_carrier = ir_rx51_set_tx_carrier;
+ rcdev->driver_name = KBUILD_MODNAME;
+
+ ir_rx51.rcdev = rcdev;
+
+ return devm_rc_register_device(&dev->dev, ir_rx51.rcdev);
+}
+
+static int ir_rx51_remove(struct platform_device *dev)
+{
+ return 0;
+}
+
+static const struct of_device_id ir_rx51_match[] = {
+ {
+ .compatible = "nokia,n900-ir",
+ },
+ {},
+};
+MODULE_DEVICE_TABLE(of, ir_rx51_match);
+
+static struct platform_driver ir_rx51_platform_driver = {
+ .probe = ir_rx51_probe,
+ .remove = ir_rx51_remove,
+ .suspend = ir_rx51_suspend,
+ .resume = ir_rx51_resume,
+ .driver = {
+ .name = KBUILD_MODNAME,
+ .of_match_table = of_match_ptr(ir_rx51_match),
+ },
+};
+module_platform_driver(ir_rx51_platform_driver);
+
+MODULE_DESCRIPTION("IR TX driver for Nokia RX51");
+MODULE_AUTHOR("Nokia Corporation");
+MODULE_LICENSE("GPL");