static char* mfser_gpio_pin_name_by_attr_name(const char* name, int port) { switch (port) { case port_1: if (! strcmp(name, "rs4xx-term-res")) { return "ap1-gpio3"; } else if (! strcmp(name, "rts-override")) { return "ap1-gpio4"; } else { log_error("attirbute name [%s] is invalid for MFSER in port %d", name, port); return ""; } case port_2: if (! strcmp(name, "rs4xx-term-res")) { return "ap2-gpio3"; } else if (! strcmp(name, "rts-override")) { return "ap2-gpio4"; } else { log_error("attirbute name [%s] is invalid for MFSER in port %d", name, port); return ""; } } } static ssize_t mts_attr_show_mfser_mode(struct kobject *kobj, struct kobj_attribute *attr, char *buf) { int ret; int port; int modesel0; int modesel1; struct gpio_pin *pin_modesel0; struct gpio_pin *pin_modesel1; port = port_from_kobject(kobj); if (port < 0) { log_error("port_from_kobject returned %d", port); return -EINVAL; } switch (port) { case port_1: pin_modesel0 = gpio_pin_by_name("AP1_GPIO1"); pin_modesel1 = gpio_pin_by_name("AP1_GPIO2"); break; case port_2: pin_modesel0 = gpio_pin_by_name("AP2_GPIO1"); pin_modesel1 = gpio_pin_by_name("AP2_GPIO2"); break; default: log_error("unknown serial-mode attr [%s]", attr->attr.name); return -ENODEV; } if (!pin_modesel0 || !pin_modesel1) return -ENODEV; mutex_lock(&mts_io_mutex); modesel0 = gpio_get_value(pin_modesel0->pin.gpio); modesel1 = gpio_get_value(pin_modesel1->pin.gpio); if (modesel1 == 0 && modesel0 == 0) ret = sprintf(buf, "loopback\n"); else if (modesel1 == 0 && modesel0 == 1) ret = sprintf(buf, "rs232\n"); else if (modesel1 == 1 && modesel0 == 0) ret = sprintf(buf, "rs485-half\n"); else if (modesel1 == 1 && modesel0 == 1) ret = sprintf(buf, "rs422-485-full\n"); else ret = sprintf(buf, "error\n"); mutex_unlock(&mts_io_mutex); return ret; } static ssize_t mts_attr_store_mfser_mode(struct kobject *kobj, struct kobj_attribute *attr, const char *buf, size_t count) { int port; int modesel0; int modesel1; struct gpio_pin *pin_modesel0; struct gpio_pin *pin_modesel1; port = port_from_kobject(kobj); if (port < 0) { log_error("port_from_kobject returned %d", port); return -EINVAL; } switch (port) { case port_1: pin_modesel0 = gpio_pin_by_name("AP1_GPIO1"); pin_modesel1 = gpio_pin_by_name("AP1_GPIO2"); break; case port_2: pin_modesel0 = gpio_pin_by_name("AP2_GPIO1"); pin_modesel1 = gpio_pin_by_name("AP2_GPIO2"); break; default: log_error("unknown serial-mode attr [%s]", attr->attr.name); return -ENODEV; } if (!pin_modesel0 || !pin_modesel1) return -ENODEV; if (!strcasecmp(buf, "loopback")) { modesel1 = 0; modesel0 = 0; } else if (!strcasecmp(buf, "rs232")) { modesel1 = 0; modesel0 = 1; } else if (!strcasecmp(buf, "rs485-half")) { modesel1 = 1; modesel0 = 0; } else if (!strcasecmp(buf, "rs422-485-full")) { modesel1 = 1; modesel0 = 1; } else { return -EINVAL; } mutex_lock(&mts_io_mutex); gpio_set_value(pin_modesel0->pin.gpio, modesel0); gpio_set_value(pin_modesel1->pin.gpio, modesel1); mutex_unlock(&mts_io_mutex); return count; } // 1 serial mode // 1 rs4xx term resistor // 1 rts override // 1 vendor-id // 1 product-id // 1 device-id // 1 hw-version // NULL static size_t ap_mfser_attrs_size = 8; static bool mfser_setup(enum ap port) { int i; int port_index = port - 1; int index = 0; int count = 0; int ret; char buf[32]; struct kobj_attribute* attr; struct attribute **attrs; log_info("loading MFSER accessory card in port %d", port); sprintf(buf, "ap%d", port); ap_subdirs[port_index] = kobject_create_and_add(buf, &mts_io_platform_device->dev.kobj); if (! ap_subdirs[port_index]) { log_error("kobject_create_and_add for MFSER in port %d failed", port); return false; } // create the link to the apX directory this card is in // if we're in the first slot, we get plain "mfser" // if we're in a different slot, we might need to use "mfser-2" to differentiate if (port > 1) { for (i = 1; i < port; i++) { if (port_info[i - 1]) { if (strstr(port_info[i - 1]->product_id, PRODUCT_ID_MTAC_MFSER)) { count++; } } } } if (count > 0) { sprintf(buf, "mfser-%d", count + 1); } else { sprintf(buf, "mfser"); } ret = sysfs_create_link(ap_subdirs[port_index]->parent, ap_subdirs[port_index], buf); if (ret) { log_error("failed to link [%s] to [%s], %d", buf, ap_subdirs[port_index]->name, ret); } attrs = kzalloc(sizeof(struct attribute*) * ap_mfser_attrs_size, GFP_KERNEL); if (! attrs) { log_error("failed to allocate attribute space for port %d", port); return false; } sprintf(buf, "serial-mode"); attr = create_attribute(buf, MTS_ATTR_MODE_RW); if (! attr) { log_error("failed to create attribute [%s] for MFSER in port %d", buf, port); return false; } attr->show = mts_attr_show_mfser_mode; attr->store = mts_attr_store_mfser_mode; attrs[index++] = &attr->attr; sprintf(buf, "rs4xx-term-res"); attr = create_attribute(buf, MTS_ATTR_MODE_RW); if (! attr) { log_error("failed to create attribute [%s] for MFSER in port %d", buf, port); return false; } attr->show = mts_attr_show_ap_gpio_pin; attr->store = mts_attr_store_ap_gpio_pin; attrs[index++] = &attr->attr; sprintf(buf, "rts-override"); attr = create_attribute(buf, MTS_ATTR_MODE_RW); if (! attr) { log_error("failed to create attribute [%s] for MFSER in port %d", buf, port); return false; } attr->show = mts_attr_show_ap_gpio_pin; attr->store = mts_attr_store_ap_gpio_pin; attrs[index++] = &attr->attr; // add attributes for eeprom contents if (! ap_add_product_info_attributes(port, MTAC_MFSER_0_0, attrs, &index)) { log_error("failed to add product info attributes for MFSER in port %d", port); return false; } attrs[index] = NULL; ap_attr_groups[port_index].attrs = attrs; if (sysfs_create_group(ap_subdirs[port_index], &ap_attr_groups[port_index])) { log_error("sysfs_create_group failed for MFSER in port %d", port); return false; } return true; } static bool mfser_teardown(enum ap port) { int i; int port_index = port - 1; struct attribute **attrs = ap_attr_groups[port_index].attrs; log_info("unloading MFSER accessory card in port %d", port); // clean up allocated memory for attributes for (i = 0; i < ap_mfser_attrs_size; i++) { if (attrs[i]) { if (attrs[i]->name) kfree(attrs[i]->name); kfree(attrs[i]); } } kfree(attrs); // clean up our "apX/" kobject if it exists if (ap_subdirs[port_index]) { kobject_put(ap_subdirs[port_index]); } return true; } bool set_mfser_info(struct ap_info* info) { snprintf(info->product_id, 32, "%s", PRODUCT_ID_MTAC_MFSER); info->setup = &mfser_setup; info->teardown = &mfser_teardown; info->gpio_pin_name_by_attr_name = &mfser_gpio_pin_name_by_attr_name; return true; }