Commit bb208037 authored by Andreas Klinger's avatar Andreas Klinger Committed by Jonathan Cameron

srf04.c: add maxbotix ultrasonic sensors

add Maxbotix LV ultrasonic sensor types mb1000, mb1010, mb1020, mb1030
and mb1040

add a configuration struct with the different trigger pulse lengths
Signed-off-by: default avatarAndreas Klinger <ak@it-klinger.de>
Signed-off-by: default avatarJonathan Cameron <Jonathan.Cameron@huawei.com>
parent 1c2fb405
...@@ -23,7 +23,7 @@ ...@@ -23,7 +23,7 @@
* trig: --+ +------------------------------------------------------ * trig: --+ +------------------------------------------------------
* ^ ^ * ^ ^
* |<->| * |<->|
* udelay(10) * udelay(trigger_pulse_us)
* *
* ultra +-+ +-+ +-+ * ultra +-+ +-+ +-+
* sonic | | | | | | * sonic | | | | | |
...@@ -48,6 +48,7 @@ ...@@ -48,6 +48,7 @@
#include <linux/kernel.h> #include <linux/kernel.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/of.h> #include <linux/of.h>
#include <linux/of_device.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/property.h> #include <linux/property.h>
#include <linux/sched.h> #include <linux/sched.h>
...@@ -56,6 +57,10 @@ ...@@ -56,6 +57,10 @@
#include <linux/iio/iio.h> #include <linux/iio/iio.h>
#include <linux/iio/sysfs.h> #include <linux/iio/sysfs.h>
struct srf04_cfg {
unsigned long trigger_pulse_us;
};
struct srf04_data { struct srf04_data {
struct device *dev; struct device *dev;
struct gpio_desc *gpiod_trig; struct gpio_desc *gpiod_trig;
...@@ -66,6 +71,15 @@ struct srf04_data { ...@@ -66,6 +71,15 @@ struct srf04_data {
ktime_t ts_falling; ktime_t ts_falling;
struct completion rising; struct completion rising;
struct completion falling; struct completion falling;
const struct srf04_cfg *cfg;
};
static const struct srf04_cfg srf04_cfg = {
.trigger_pulse_us = 10,
};
static const struct srf04_cfg mb_lv_cfg = {
.trigger_pulse_us = 20,
}; };
static irqreturn_t srf04_handle_irq(int irq, void *dev_id) static irqreturn_t srf04_handle_irq(int irq, void *dev_id)
...@@ -102,7 +116,7 @@ static int srf04_read(struct srf04_data *data) ...@@ -102,7 +116,7 @@ static int srf04_read(struct srf04_data *data)
reinit_completion(&data->falling); reinit_completion(&data->falling);
gpiod_set_value(data->gpiod_trig, 1); gpiod_set_value(data->gpiod_trig, 1);
udelay(10); udelay(data->cfg->trigger_pulse_us);
gpiod_set_value(data->gpiod_trig, 0); gpiod_set_value(data->gpiod_trig, 0);
/* it cannot take more than 20 ms */ /* it cannot take more than 20 ms */
...@@ -215,6 +229,18 @@ static const struct iio_chan_spec srf04_chan_spec[] = { ...@@ -215,6 +229,18 @@ static const struct iio_chan_spec srf04_chan_spec[] = {
}, },
}; };
static const struct of_device_id of_srf04_match[] = {
{ .compatible = "devantech,srf04", .data = &srf04_cfg},
{ .compatible = "maxbotix,mb1000", .data = &mb_lv_cfg},
{ .compatible = "maxbotix,mb1010", .data = &mb_lv_cfg},
{ .compatible = "maxbotix,mb1020", .data = &mb_lv_cfg},
{ .compatible = "maxbotix,mb1030", .data = &mb_lv_cfg},
{ .compatible = "maxbotix,mb1040", .data = &mb_lv_cfg},
{},
};
MODULE_DEVICE_TABLE(of, of_srf04_match);
static int srf04_probe(struct platform_device *pdev) static int srf04_probe(struct platform_device *pdev)
{ {
struct device *dev = &pdev->dev; struct device *dev = &pdev->dev;
...@@ -230,6 +256,7 @@ static int srf04_probe(struct platform_device *pdev) ...@@ -230,6 +256,7 @@ static int srf04_probe(struct platform_device *pdev)
data = iio_priv(indio_dev); data = iio_priv(indio_dev);
data->dev = dev; data->dev = dev;
data->cfg = of_match_device(of_srf04_match, dev)->data;
mutex_init(&data->lock); mutex_init(&data->lock);
init_completion(&data->rising); init_completion(&data->rising);
...@@ -280,13 +307,6 @@ static int srf04_probe(struct platform_device *pdev) ...@@ -280,13 +307,6 @@ static int srf04_probe(struct platform_device *pdev)
return devm_iio_device_register(dev, indio_dev); return devm_iio_device_register(dev, indio_dev);
} }
static const struct of_device_id of_srf04_match[] = {
{ .compatible = "devantech,srf04", },
{},
};
MODULE_DEVICE_TABLE(of, of_srf04_match);
static struct platform_driver srf04_driver = { static struct platform_driver srf04_driver = {
.probe = srf04_probe, .probe = srf04_probe,
.driver = { .driver = {
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment