Status of I-8042 4 analog output channels can be managed via
sysfs.

http://www.icpdas.com/root/product/solutions/remote_io/rs-485/i-8k_i-87k/i-8024w.html

Signed-off-by: Sergei Ianovich <ynv...@gmail.com>
---
 Documentation/misc-devices/lp8x4x_bus.txt | 15 ++++++
 drivers/misc/lp8x4x_bus.c                 | 89 +++++++++++++++++++++++++++++++
 2 files changed, 104 insertions(+)

diff --git a/Documentation/misc-devices/lp8x4x_bus.txt 
b/Documentation/misc-devices/lp8x4x_bus.txt
index e3a8bcf..08419d1 100644
--- a/Documentation/misc-devices/lp8x4x_bus.txt
+++ b/Documentation/misc-devices/lp8x4x_bus.txt
@@ -57,3 +57,18 @@ input_status
 output_status
        RW - set status of digital output channels on the module in
             the expansion slot. Value can be read back.
+
+analog_output
+       RW - set status of analog output channels on the module in
+            the expansion slot. Tested with voltage output. Bits 0-13:
+            0x00c0 is -10.0V
+            0x2000 is   0.0V
+            0x3f40 is +10.0V
+
+            So 1 unit of output is 1.25 mV.
+
+            Bits 15 and 14 determine which channel to apply the value:
+            0x0000 is channel 1
+            0x4000 is channel 2
+            0x8000 is channel 3
+            0xc000 is channel 4
diff --git a/drivers/misc/lp8x4x_bus.c b/drivers/misc/lp8x4x_bus.c
index fce11c4..0fa13a3 100644
--- a/drivers/misc/lp8x4x_bus.c
+++ b/drivers/misc/lp8x4x_bus.c
@@ -14,6 +14,8 @@
 #include <linux/list.h>
 #include <linux/slab.h>
 #include <linux/gpio.h>
+#include <linux/sched.h>
+#include <linux/hrtimer.h>
 
 #include <mach/mfp-pxa27x.h>
 #include <mach/lp8x4x.h>
@@ -24,6 +26,7 @@ MODULE_LICENSE("GPL");
 MODULE_AUTHOR("Sergei Ianovich <ynv...@gmail.com>");
 MODULE_DESCRIPTION("ICP DAS LP-8x4x parallel bus driver");
 
+#define LP8X4X_MAX_AO_CHANNELS 4
 struct lp8x4x_slot {
        void                    *data_addr;
        unsigned int            model;
@@ -32,6 +35,8 @@ struct lp8x4x_slot {
        u32                     DO;
        unsigned int            DI_len;
        u32                     DI;
+       unsigned int            AO_len;
+       u32                     AO[LP8X4X_MAX_AO_CHANNELS];
        struct device           dev;
 };
 
@@ -118,6 +123,36 @@ static void lp8x4x_slot_set_DO(struct lp8x4x_slot *s)
        mutex_unlock(&s->lock);
 }
 
+void nsleep(unsigned long nanosec)
+{
+       ktime_t t = ns_to_ktime(nanosec);
+       long state = current->state;
+
+       __set_current_state(TASK_UNINTERRUPTIBLE);
+       schedule_hrtimeout(&t, HRTIMER_MODE_REL);
+       __set_current_state(state);
+}
+
+static void lp8x4x_slot_reset_AO(struct lp8x4x_slot *s)
+{
+       int i;
+       mutex_lock(&s->lock);
+       for (i = 0; i < s->AO_len; i++)
+               s->AO[i] = 0x2000;
+       iowrite8(0x00, s->data_addr);
+       nsleep(450);
+       iowrite8(0xff, s->data_addr);
+       mutex_unlock(&s->lock);
+}
+
+static void lp8x4x_slot_set_AO(struct lp8x4x_slot *s, u32 val)
+{
+       mutex_lock(&s->lock);
+       iowrite8(val & 0xff, s->data_addr + 2);
+       iowrite8((val >> 8) & 0xff, s->data_addr + 4);
+       mutex_unlock(&s->lock);
+}
+
 static ssize_t input_status_show(struct device *dev,
                struct device_attribute *attr, char *buf)
 {
@@ -189,6 +224,48 @@ static ssize_t output_status_store(struct device *dev,
 
 static DEVICE_ATTR_RW(output_status);
 
+static ssize_t analog_output_show(struct device *dev,
+               struct device_attribute *attr, char *buf)
+{
+       struct lp8x4x_slot *s = container_of(dev, struct lp8x4x_slot, dev);
+       int i, c = 0;
+
+       for (i = 0; i < s->AO_len; i++)
+               c += sprintf(&buf[c], "0x%04x\n", s->AO[i]);
+       return c;
+}
+
+static ssize_t analog_output_store(struct device *dev,
+               struct device_attribute *attr, const char *buf, size_t count)
+{
+       struct lp8x4x_slot *s = container_of(dev, struct lp8x4x_slot, dev);
+       u32 AO;
+       int i;
+
+       if (!buf)
+               return count;
+       if (0 == count)
+               return count;
+
+       if (kstrtouint(buf, 16, &AO) != 0) {
+               dev_err(dev, "bad input\n");
+               return count;
+       }
+
+       if (AO & 0xffff0000) {
+               dev_err(dev, "bad input\n");
+               return count;
+       }
+
+       i = AO >> 14;
+       s->AO[i] = AO & 0x3fff;
+       lp8x4x_slot_set_AO(s, AO);
+
+       return count;
+}
+
+static DEVICE_ATTR_RW(analog_output);
+
 static ssize_t model_show(struct device *dev,
                struct device_attribute *attr, char *buf)
 {
@@ -220,6 +297,13 @@ static struct attribute *dio_slot_dev_attrs[] = {
 };
 ATTRIBUTE_GROUPS(dio_slot_dev);
 
+static struct attribute *ao_slot_dev_attrs[] = {
+       &dev_attr_model.attr,
+       &dev_attr_analog_output.attr,
+       NULL,
+};
+ATTRIBUTE_GROUPS(ao_slot_dev);
+
 static void lp8x4x_master_release(struct device *dev)
 {
        struct lp8x4x_master *m = container_of(dev, struct lp8x4x_master, dev);
@@ -324,6 +408,11 @@ static void __init lp8x4x_bus_probe_slot(struct 
lp8x4x_master *m, int i,
        mutex_init(&s->lock);
 
        switch (model) {
+       case 24:
+               s->AO_len = 4;
+               lp8x4x_slot_reset_AO(s);
+               s->dev.groups = ao_slot_dev_groups;
+               break;
        case 41:
                s->DO_len = 4;
                lp8x4x_slot_set_DO(s);
-- 
1.8.4.2

--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/

Reply via email to