summaryrefslogtreecommitdiff
path: root/io-module/mtac_mfser.c
diff options
context:
space:
mode:
Diffstat (limited to 'io-module/mtac_mfser.c')
-rw-r--r--io-module/mtac_mfser.c286
1 files changed, 0 insertions, 286 deletions
diff --git a/io-module/mtac_mfser.c b/io-module/mtac_mfser.c
deleted file mode 100644
index 26fd339..0000000
--- a/io-module/mtac_mfser.c
+++ /dev/null
@@ -1,286 +0,0 @@
-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 "";
- }
- }
- 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;
-}
generated by cgit v1.2.3 (git 2.25.1) at 2024-06-01 09:39:07 +0000