struct gpio_pin *ap_gpio_pin_by_attr_name(const char *name) { struct gpio_pin *pin; char *pin_attr_name; if (!strcmp(name, "ap1-led1")) { pin_attr_name = "ap1-gpio3"; } else if (!strcmp(name, "ap1-led2")) { pin_attr_name = "ap1-gpio4"; } else if (!strcmp(name, "ap1-dout-enable")) { pin_attr_name = "ap1-gpio1"; } else if (!strcmp(name, "ap1-reset")) { pin_attr_name = "ap1-reset"; } else if (!strcmp(name, "ap2-led1")) { pin_attr_name = "ap2-gpio3"; } else if (!strcmp(name, "ap2-led2")) { pin_attr_name = "ap2-gpio4"; } else if (!strcmp(name, "ap2-dout-enable")) { pin_attr_name = "ap2-gpio1"; } else if (!strcmp(name, "ap2-reset")) { pin_attr_name = "ap2-reset"; } else { log_error("accessory card attribute %s not available", name); return NULL; } for (pin = gpio_pins; *pin->name; pin++) { if (!strcmp(pin->pin.label, pin_attr_name)) { return pin; } } log_error("pin with attr name %s not found", name); return NULL; } static ssize_t mts_attr_show_ap_gpio_pin(struct device *dev, struct device_attribute *attr, char *buf) { int value; struct gpio_pin *pin = ap_gpio_pin_by_attr_name(attr->attr.name); if (!pin) { return -ENODEV; } mutex_lock(&mts_io_mutex); value = gpio_get_value(pin->pin.gpio); mutex_unlock(&mts_io_mutex); if (value < 0) { return value; } if (pin->active_low) { value = !value; } return sprintf(buf, "%d\n", value); } static ssize_t mts_attr_store_ap_gpio_pin(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { int value; struct gpio_pin *pin = ap_gpio_pin_by_attr_name(attr->attr.name); if (!pin) { return -ENODEV; } if (sscanf(buf, "%i", &value) != 1) { return -EINVAL; } if (pin->active_low) { value = !value; } mutex_lock(&mts_io_mutex); gpio_set_value(pin->pin.gpio, value); mutex_unlock(&mts_io_mutex); return count; } static ssize_t mts_attr_show_ap_din(struct device *dev, struct device_attribute *attr, char *buf) { int tmp; u8 bit; u8 byte; struct spi_device* spi_dev; if (strstr(attr->attr.name, ":0")) { if (!spi_ap1_din_dev) { log_error("accessory card 1 din device not present"); return -ENODEV; } spi_dev = spi_ap1_din_dev; } else if (strstr(attr->attr.name, ":1")) { if (!spi_ap2_din_dev) { log_error("accessory card 2 din device not present"); return -ENODEV; } spi_dev = spi_ap2_din_dev; } else { log_error("unknown din device %s", attr->attr.name); return -ENODEV; } if (strstr(attr->attr.name, "din0")) { bit = BIT(0); } else if (strstr(attr->attr.name, "din1")) { bit = BIT(1); } else if (strstr(attr->attr.name, "din2")) { bit = BIT(2); } else if (strstr(attr->attr.name, "din3")) { bit = BIT(3); } else { log_error("accessory card din attr does not exist"); return -ENOENT; } tmp = spi_readn(spi_dev, &byte, 1); if (tmp) { log_error("spi_read failed %d", tmp); return tmp; } tmp = byte & bit ? 1 : 0; return sprintf(buf, "%d\n", tmp); } static ssize_t mts_attr_store_ap_dout(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) { int value; u8 bit; struct spi_device* spi_dev; if (strstr(attr->attr.name, ":0")) { if (!spi_ap1_dout_dev) { log_error("accessory card 1 dout device not present"); return -ENODEV; } spi_dev = spi_ap1_dout_dev; } else if (strstr(attr->attr.name, ":1")) { if (!spi_ap2_dout_dev) { log_error("accessory card 2 dout device not present"); return -ENODEV; } spi_dev = spi_ap2_dout_dev; } else { log_error("unknown dout device %s", attr->attr.name); return -ENODEV; } if (strstr(attr->attr.name, "dout0")) { bit = BIT(0); } else if (strstr(attr->attr.name, "dout1")) { bit = BIT(1); } else if (strstr(attr->attr.name, "dout2")) { bit = BIT(2); } else if (strstr(attr->attr.name, "dout3")) { bit = BIT(3); } else { log_error("accessory card dout attr does not exist"); return -ENOENT; } if (sscanf(buf, "%i", &value) != 1) { log_error("accessory card dout attr invalid argument"); return -EINVAL; } mutex_lock(&spi_ap_dout_mutex); if (value) { spi_ap_dout_value &= ~bit; } else { spi_ap_dout_value |= bit; } spi_writen(spi_dev, &spi_ap_dout_value, 1); mutex_unlock(&spi_ap_dout_mutex); return count; } static ssize_t mts_attr_show_ap_dout(struct device *dev, struct device_attribute *attr, char *buf) { int value; u8 bit; struct spi_device* spi_dev; if (strstr(attr->attr.name, ":0")) { if (!spi_ap1_dout_dev) { log_error("accessory card 1 dout device not present"); return -ENODEV; } spi_dev = spi_ap1_dout_dev; } else if (strstr(attr->attr.name, ":1")) { if (!spi_ap2_dout_dev) { log_error("accessory card 2 dout device not present"); return -ENODEV; } spi_dev = spi_ap2_dout_dev; } else { log_error("unknown dout device %s", attr->attr.name); return -ENODEV; } if (strstr(attr->attr.name, "dout0")) { bit = BIT(0); } else if (strstr(attr->attr.name, "dout1")) { bit = BIT(1); } else if (strstr(attr->attr.name, "dout2")) { bit = BIT(2); } else if (strstr(attr->attr.name, "dout3")) { bit = BIT(3); } else { log_error("accessory card dout attr does not exist"); return -ENOENT; } mutex_lock(&spi_ap_dout_mutex); value = spi_ap_dout_value & bit ? 0 : 1; mutex_unlock(&spi_ap_dout_mutex); return sprintf(buf, "%d\n", value); } static ssize_t mts_attr_show_ap_adc(struct device *dev, struct device_attribute *attr, char *buf) { int tmp; int tx_data; int rx_data; int channel; int channel_mask = 0x0180; /* 0b 0000 0001 1000 0000 */ int manual_mode = 0x1840; /* 0b 0001 1000 0100 0000 */ uint8_t tx[2]; uint8_t rx[2]; struct spi_device* spi_dev; memset(tx, 0, sizeof(tx)); memset(rx, 0, sizeof(rx)); if (strstr(attr->attr.name, ":0")) { if (!spi_ap1_adc_dev) { log_error("accessory card 1 adc device not present"); return -ENODEV; } spi_dev = spi_ap1_adc_dev; } else if (strstr(attr->attr.name, ":1")) { if (!spi_ap2_adc_dev) { log_error("accessory card 2 adc device not present"); return -ENODEV; } spi_dev = spi_ap2_adc_dev; } else { log_error("unknown adc device %s", attr->attr.name); return -ENODEV; } if (strstr(attr->attr.name, "adc0")) { channel = 0; } else if (strstr(attr->attr.name, "adc1")) { channel = 1; } else if (strstr(attr->attr.name, "adc2")) { channel = 2; } else { log_error("accessory card adc attr does not exist"); return -ENOENT; } /* 1st transfer to set up (5V reference, channel to read from) */ tx_data = manual_mode | ((channel << 7) & channel_mask); tx[0] = tx_data >> 8; tx[1] = tx_data & 0xFF; tmp = spi_writen(spi_dev, tx, 2); if (tmp) { log_error("spi_write failed %d", tmp); return tmp; } /* 2nd transfer to clock chip for ADC conversion * this can be a throw-away read or an empty write, * the ADC just needs the clock running so it can convert */ tx[0] = 0; tx[1] = 0; tmp = spi_writen(spi_dev, tx, 2); if (tmp) { log_error("2nd spi_write failed %d", tmp); return tmp; } /* 3rd transfer to read data */ tmp = spi_readn(spi_dev, rx, 2); if (tmp) { log_error("spi_read failed %d", tmp); return tmp; } rx_data = ((rx[0] & 0x0F) << 8) | (rx[1] & 0xFF); return sprintf(buf, "%lu\n", (unsigned long) rx_data); } /* accessory port 1 gpiob attributes */ static DEVICE_ATTR_RO_MTS(dev_attr_ap1_gpio_din0, "din0:0", mts_attr_show_ap_din); static DEVICE_ATTR_RO_MTS(dev_attr_ap1_gpio_din1, "din1:0", mts_attr_show_ap_din); static DEVICE_ATTR_RO_MTS(dev_attr_ap1_gpio_din2, "din2:0", mts_attr_show_ap_din); static DEVICE_ATTR_RO_MTS(dev_attr_ap1_gpio_din3, "din3:0", mts_attr_show_ap_din); static DEVICE_ATTR_MTS(dev_attr_ap1_gpio_dout0, "dout0:0", mts_attr_show_ap_dout, mts_attr_store_ap_dout); static DEVICE_ATTR_MTS(dev_attr_ap1_gpio_dout1, "dout1:0", mts_attr_show_ap_dout, mts_attr_store_ap_dout); static DEVICE_ATTR_MTS(dev_attr_ap1_gpio_dout2, "dout2:0", mts_attr_show_ap_dout, mts_attr_store_ap_dout); static DEVICE_ATTR_MTS(dev_attr_ap1_gpio_dout3, "dout3:0", mts_attr_show_ap_dout, mts_attr_store_ap_dout); static DEVICE_ATTR_RO_MTS(dev_attr_ap1_gpio_adc0, "adc0:0", mts_attr_show_ap_adc); static DEVICE_ATTR_RO_MTS(dev_attr_ap1_gpio_adc1, "adc1:0", mts_attr_show_ap_adc); static DEVICE_ATTR_RO_MTS(dev_attr_ap1_gpio_adc2, "adc2:0", mts_attr_show_ap_adc); static DEVICE_ATTR_MTS(dev_attr_ap1_gpio_led1, "ap1-led1", mts_attr_show_ap_gpio_pin, mts_attr_store_ap_gpio_pin); static DEVICE_ATTR_MTS(dev_attr_ap1_gpio_led2, "ap1-led2", mts_attr_show_ap_gpio_pin, mts_attr_store_ap_gpio_pin); static DEVICE_ATTR_MTS(dev_attr_ap1_gpio_oe, "ap1-dout-enable", mts_attr_show_ap_gpio_pin, mts_attr_store_ap_gpio_pin); static DEVICE_ATTR_MTS(dev_attr_ap1_reset, "ap1-reset", mts_attr_show_ap_gpio_pin, mts_attr_store_ap_gpio_pin); static int ap1_gpio_attributes_size = 15; // not including NULL at end static struct attribute *ap1_gpio_attributes[] = { &dev_attr_ap1_reset.attr, &dev_attr_ap1_gpio_oe.attr, // gpio1 &dev_attr_ap1_gpio_led1.attr, // gpio3 &dev_attr_ap1_gpio_led2.attr, // gpio4 &dev_attr_ap1_gpio_din0.attr, &dev_attr_ap1_gpio_din1.attr, &dev_attr_ap1_gpio_din2.attr, &dev_attr_ap1_gpio_din3.attr, &dev_attr_ap1_gpio_dout0.attr, &dev_attr_ap1_gpio_dout1.attr, &dev_attr_ap1_gpio_dout2.attr, &dev_attr_ap1_gpio_dout3.attr, &dev_attr_ap1_gpio_adc0.attr, &dev_attr_ap1_gpio_adc1.attr, &dev_attr_ap1_gpio_adc2.attr, NULL, }; /* accessory port 2 gpiob attributes */ static DEVICE_ATTR_RO_MTS(dev_attr_ap2_gpio_din0, "din0:1", mts_attr_show_ap_din); static DEVICE_ATTR_RO_MTS(dev_attr_ap2_gpio_din1, "din1:1", mts_attr_show_ap_din); static DEVICE_ATTR_RO_MTS(dev_attr_ap2_gpio_din2, "din2:1", mts_attr_show_ap_din); static DEVICE_ATTR_RO_MTS(dev_attr_ap2_gpio_din3, "din3:1", mts_attr_show_ap_din); static DEVICE_ATTR_MTS(dev_attr_ap2_gpio_dout0, "dout0:1", mts_attr_show_ap_dout, mts_attr_store_ap_dout); static DEVICE_ATTR_MTS(dev_attr_ap2_gpio_dout1, "dout1:1", mts_attr_show_ap_dout, mts_attr_store_ap_dout); static DEVICE_ATTR_MTS(dev_attr_ap2_gpio_dout2, "dout2:1", mts_attr_show_ap_dout, mts_attr_store_ap_dout); static DEVICE_ATTR_MTS(dev_attr_ap2_gpio_dout3, "dout3:1", mts_attr_show_ap_dout, mts_attr_store_ap_dout); static DEVICE_ATTR_RO_MTS(dev_attr_ap2_gpio_adc0, "adc0:1", mts_attr_show_ap_adc); static DEVICE_ATTR_RO_MTS(dev_attr_ap2_gpio_adc1, "adc1:1", mts_attr_show_ap_adc); static DEVICE_ATTR_RO_MTS(dev_attr_ap2_gpio_adc2, "adc2:1", mts_attr_show_ap_adc); static DEVICE_ATTR_MTS(dev_attr_ap2_gpio_led1, "ap2-led1", mts_attr_show_ap_gpio_pin, mts_attr_store_ap_gpio_pin); static DEVICE_ATTR_MTS(dev_attr_ap2_gpio_led2, "ap2-led2", mts_attr_show_ap_gpio_pin, mts_attr_store_ap_gpio_pin); static DEVICE_ATTR_MTS(dev_attr_ap2_gpio_oe, "ap2-dout-enable", mts_attr_show_ap_gpio_pin, mts_attr_store_ap_gpio_pin); static DEVICE_ATTR_MTS(dev_attr_ap2_reset, "ap2-reset", mts_attr_show_ap_gpio_pin, mts_attr_store_ap_gpio_pin); static int ap2_gpio_attributes_size = 15; // not including NULL at end static struct attribute *ap2_gpio_attributes[] = { &dev_attr_ap2_reset.attr, &dev_attr_ap2_gpio_oe.attr, // gpio1 &dev_attr_ap2_gpio_led1.attr, // gpio3 &dev_attr_ap2_gpio_led2.attr, // gpio4 &dev_attr_ap2_gpio_din0.attr, &dev_attr_ap2_gpio_din1.attr, &dev_attr_ap2_gpio_din2.attr, &dev_attr_ap2_gpio_din3.attr, &dev_attr_ap2_gpio_dout0.attr, &dev_attr_ap2_gpio_dout1.attr, &dev_attr_ap2_gpio_dout2.attr, &dev_attr_ap2_gpio_dout3.attr, &dev_attr_ap2_gpio_adc0.attr, &dev_attr_ap2_gpio_adc1.attr, &dev_attr_ap2_gpio_adc2.attr, NULL, };