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.c192
1 files changed, 132 insertions, 60 deletions
diff --git a/io-module/mtac_mfser.c b/io-module/mtac_mfser.c
index 7c5862c..27ca4dc 100644
--- a/io-module/mtac_mfser.c
+++ b/io-module/mtac_mfser.c
@@ -1,15 +1,24 @@
-static char* mfser_gpio_pin_name_by_attr_name(const char* name) {
- if (! strcmp(name, "rs4xx-term-res:1")) {
- return "ap1-gpio3";
- } else if (! strcmp(name, "rts-override:1")) {
- return "ap1-gpio4";
- } else if (! strcmp(name, "rs4xx-term-res:2")) {
- return "ap2-gpio3";
- } else if (! strcmp(name, "rts-override:2")) {
- return "ap2-gpio4";
- } else {
- log_error("attirbute name [%s] is invalid for MFSER", name);
- return "";
+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 "";
+ }
}
}
@@ -18,23 +27,33 @@ static ssize_t mts_attr_show_mfser_mode(struct kobject *kobj,
char *buf)
{
int ret;
+ int port;
int modesel0;
int modesel1;
struct gpio_pin *pin_modesel0;
struct gpio_pin *pin_modesel1;
- if (strstr(attr->attr.name, ":1")) {
- pin_modesel0 = gpio_pin_by_name("AP1_GPIO1");
- pin_modesel1 = gpio_pin_by_name("AP1_GPIO2");
- }
- else if (strstr(attr->attr.name, ":2")) {
- pin_modesel0 = gpio_pin_by_name("AP2_GPIO1");
- pin_modesel1 = gpio_pin_by_name("AP2_GPIO2");
+ port = port_from_kobject(kobj);
+ if (port < 0) {
+ log_error("port_from_kobject returned %d", port);
+ return -EINVAL;
}
- else {
- log_error("unknown serial-mode attr %s", attr->attr.name);
- return -ENODEV;
+
+ 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)
@@ -64,22 +83,32 @@ static ssize_t mts_attr_show_mfser_mode(struct kobject *kobj,
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;
- if (strstr(attr->attr.name, ":1")) {
- pin_modesel0 = gpio_pin_by_name("AP1_GPIO1");
- pin_modesel1 = gpio_pin_by_name("AP1_GPIO2");
- }
- else if (strstr(attr->attr.name, ":2")) {
- pin_modesel0 = gpio_pin_by_name("AP2_GPIO1");
- pin_modesel1 = gpio_pin_by_name("AP2_GPIO2");
+ port = port_from_kobject(kobj);
+ if (port < 0) {
+ log_error("port_from_kobject returned %d", port);
+ return -EINVAL;
}
- else {
- log_error("unknown serial-mode attr %s", attr->attr.name);
- return -ENODEV;
+
+ 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)
@@ -122,57 +151,97 @@ static ssize_t mts_attr_store_mfser_mode(struct kobject *kobj,
// 1 product-id
// 1 device-id
// 1 hw-version
-static int ap_mfser_attrs_size = 7;
+// NULL
+static size_t ap_mfser_attrs_size = 8;
static bool mfser_setup(enum ap port) {
+ int i;
int port_index = port - 1;
- struct kobj_attribute *attr;
+ 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);
- if (device_attrs_size + ap_mfser_attrs_size >= device_attrs_max_size) {
- log_error("can't load MFSER accessory card in port %d - not enough room for attributes", 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;
}
- // mark the attribute indices we're using so we know what to clean up
- port_info[port_index]->attrs_start = device_attrs_size;
- port_info[port_index]->attrs_end = device_attrs_size + ap_mfser_attrs_size;
+ // 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:%d", port);
+ sprintf(buf, "serial-mode");
attr = create_attribute(buf, MTS_ATTR_MODE_RW);
if (! attr) {
- log_error("failed to create attribute[%s]", buf);
+ 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;
- device_attrs[device_attrs_size++] = &attr->attr;
+ attrs[index++] = &attr->attr;
- sprintf(buf, "rs4xx-term-res:%d", port);
+ sprintf(buf, "rs4xx-term-res");
attr = create_attribute(buf, MTS_ATTR_MODE_RW);
if (! attr) {
- log_error("failed to create attribute[%s]", buf);
+ 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;
- device_attrs[device_attrs_size++] = &attr->attr;
+ attrs[index++] = &attr->attr;
- sprintf(buf, "rts-override:%d", port);
+ sprintf(buf, "rts-override");
attr = create_attribute(buf, MTS_ATTR_MODE_RW);
if (! attr) {
- log_error("failed to create attribute[%s]", buf);
+ 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;
- device_attrs[device_attrs_size++] = &attr->attr;
+ attrs[index++] = &attr->attr;
// add attributes for eeprom contents
- if (! ap_add_product_info_attributes(port, MTAC_MFSER_0_0)) {
- log_error("failed to add product info attributes");
+ 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;
}
@@ -182,31 +251,34 @@ static bool mfser_setup(enum ap port) {
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 = port_info[port_index]->attrs_start; i < port_info[port_index]->attrs_end; i++) {
- if (device_attrs[i]) {
- if (device_attrs[i]->name)
- kfree(device_attrs[i]->name);
+ for (i = 0; i < ap_mfser_attrs_size; i++) {
+ if (attrs[i]) {
+ if (attrs[i]->name)
+ kfree(attrs[i]->name);
- kfree(device_attrs[i]);
+ kfree(attrs[i]);
}
}
- port_info[port_index]->attrs_start = 0;
- port_info[port_index]->attrs_end = 0;
+ 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) {
- info->product_id = MTAC_MFSER_0_0;
+ snprintf(info->product_id, 32, "%s", PRODUCT_ID_MTAC_MFSER);
info->setup = &mfser_setup;
info->teardown = &mfser_teardown;
- info->attrs_start = 0;
- info->attrs_end = 0;
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-03 05:33:33 +0000