libusbgx: Add support for importing/exporting loopback function

Now it is also possible to use loopback function in gadget
schemes.

Signed-off-by: Krzysztof Opasiak <k.opasiak@samsung.com>

diff --git a/src/usbg_schemes_libconfig.c b/src/usbg_schemes_libconfig.c
index 0f6a99a..c8944ed 100644 (file)
--- a/src/usbg_schemes_libconfig.c
+++ b/src/usbg_schemes_libconfig.c
@@ -485,6 +485,39 @@ out:
        return ret;
 }
 
+static int usbg_export_f_loopback_attrs(usbg_f_loopback_attrs *attrs,
+                                     config_setting_t *root)
+{
+       config_setting_t *node;
+       int cfg_ret;
+       int ret = USBG_ERROR_NO_MEM;
+
+#define ADD_F_LOOPBACK_INT_ATTR(attr, minval)                          \
+       do {                                                            \
+               if ((int)attrs->attr < minval) {                        \
+                       ret = USBG_ERROR_INVALID_VALUE;                 \
+                       goto out;                                       \
+               }                                                       \
+               node = config_setting_add(root, #attr, CONFIG_TYPE_INT);\
+               if (!node)                                              \
+                       goto out;                                       \
+               cfg_ret = config_setting_set_int(node, attrs->attr);    \
+               if (cfg_ret != CONFIG_TRUE) {                           \
+                       ret = USBG_ERROR_OTHER_ERROR;                   \
+                       goto out;                                       \
+               }                                                       \
+       } while (0)
+
+       ADD_F_LOOPBACK_INT_ATTR(buflen, 0);
+       ADD_F_LOOPBACK_INT_ATTR(qlen, 0);
+
+#undef ADD_F_LOOPBACK_INT_ATTR
+
+       ret = USBG_SUCCESS;
+out:
+       return ret;
+}
+
 static int usbg_export_function_attrs(usbg_function *f, config_setting_t *root)
 {
        config_setting_t *node;
@@ -520,6 +553,10 @@ static int usbg_export_function_attrs(usbg_function *f, config_setting_t *root)
                ret = usbg_export_f_midi_attrs(&f_attrs.attrs.midi, root);
                break;
 
+       case USBG_F_ATTRS_LOOPBACK:
+               ret = usbg_export_f_loopback_attrs(&f_attrs.attrs.loopback, root);
+               break;
+
        case USBG_F_ATTRS_PHONET:
                /* Don't export ifname because it is read only */
        case USBG_F_ATTRS_FFS:
@@ -1191,6 +1228,45 @@ out:
        return ret;
 }
 
+static int usbg_import_f_loopback_attrs(config_setting_t *root,  usbg_function *f)
+{
+       config_setting_t *node;
+       int ret = USBG_ERROR_NO_MEM;
+       int tmp;
+       usbg_function_attrs attrs;
+       usbg_f_loopback_attrs *loopback_attrs = &attrs.attrs.loopback;
+
+       attrs.header.attrs_type = USBG_F_ATTRS_LOOPBACK;
+
+#define ADD_F_LOOPBACK_INT_ATTR(attr, defval, minval)                  \
+       do {                                                            \
+               node = config_setting_get_member(root, #attr);          \
+               if (node) {                                             \
+                       if (!usbg_config_is_int(node)) {                \
+                               ret = USBG_ERROR_INVALID_TYPE;          \
+                               goto out;                               \
+                       }                                               \
+                       tmp = config_setting_get_int(node);             \
+                       if (tmp < minval) {                             \
+                               ret = USBG_ERROR_INVALID_VALUE;         \
+                               goto out;                               \
+                       }                                               \
+                       loopback_attrs->attr = tmp;                             \
+               } else {                                                \
+                       loopback_attrs->attr = defval;                  \
+               }                                                       \
+       } while (0)
+
+       ADD_F_LOOPBACK_INT_ATTR(buflen, 4096, 0);
+       ADD_F_LOOPBACK_INT_ATTR(qlen, 32, 0);
+
+#undef ADD_F_LOOPBACK_INT_ATTR
+
+       ret = usbg_set_function_attrs(f, &attrs);
+out:
+       return ret;
+}
+
 static int usbg_import_function_attrs(config_setting_t *root, usbg_function *f)
 {
        int ret = USBG_SUCCESS;
@@ -1228,6 +1304,10 @@ static int usbg_import_function_attrs(config_setting_t *root, usbg_function *f)
                ret = usbg_import_f_midi_attrs(root, f);
                break;
 
+       case USBG_F_ATTRS_LOOPBACK:
+               ret = usbg_import_f_loopback_attrs(root, f);
+               break;
+
        default:
                ERROR("Unsupported function type\n");
                ret = USBG_ERROR_NOT_SUPPORTED;