Start services for legacy functions

Change-Id: Ie5913698b135e45f3e55267d6830f2aa996e96a4
Signed-off-by: Paweł Szewczyk <p.szewczyk@samsung.com>

3 files changed, 122 insertions, 5 deletions

diff --git a/hw/usb_client/CMakeLists.txt b/hw/usb_client/CMakeLists.txt
index f7b32c1..4a10107 100644
--- a/hw/usb_client/CMakeLists.txt
+++ b/hw/usb_client/CMakeLists.txt
@@ -4,7 +4,7 @@ PROJECT(usb_client C)
 SET(PREFIX ${CMAKE_INSTALL_PREFIX})
 
 INCLUDE(FindPkgConfig)
-pkg_check_modules(usb_client_pkgs REQUIRED hwcommon dlog glib-2.0)
+pkg_check_modules(usb_client_pkgs REQUIRED hwcommon dlog glib-2.0 libusbgx libsystemd)
 
 FOREACH(flag ${usb_client_pkgs_CFLAGS})
 	SET(EXTRA_CFLAGS "${EXTRA_CFLAGS} ${flag}")
diff --git a/hw/usb_client/usb_client.c b/hw/usb_client/usb_client.c
index 2716eea..f7faa5b 100644
--- a/hw/usb_client/usb_client.c
+++ b/hw/usb_client/usb_client.c
@@ -23,6 +23,7 @@
 #include <limits.h>
 #include <stdio.h>
 #include <string.h>
+#include <systemd/sd-bus.h>
 
 #define zalloc(amount) calloc(1, amount)
 
@@ -61,6 +62,63 @@
 /* +5 to be always big enough */
 #define INT_BUF_SIZE (sizeof(int)*8 + 5)
 
+#define SYSTEMD_DBUS_SERVICE "org.freedesktop.systemd1"
+#define SYSTEMD_DBUS_PATH "/org/freedesktop/systemd1"
+#define SYSTEMD_DBUS_MANAGER_IFACE "org.freedesktop.systemd1.Manager"
+
+#define SYSTEMD_SERVICE_SUFFIX ".service"
+#define MAX_SERVICE_NAME 1024
+
+static int systemd_unit_interface(const char *method, const char *unit)
+{
+	sd_bus *bus = NULL;
+	int r;
+
+	r = sd_bus_open_system(&bus);
+	if (r < 0)
+		return r;
+
+	r = sd_bus_call_method(bus,
+			SYSTEMD_DBUS_SERVICE,
+			SYSTEMD_DBUS_PATH,
+			SYSTEMD_DBUS_MANAGER_IFACE,
+			method,
+			NULL,
+			NULL,
+			"ss",
+			unit,
+			"replace");
+
+	sd_bus_unref(bus);
+	return r;
+}
+
+static int systemd_start_service(const char *service_name)
+{
+	char unit[MAX_SERVICE_NAME];
+	int ret;
+
+	ret = snprintf(unit, sizeof(unit), "%s" SYSTEMD_SERVICE_SUFFIX,
+		       service_name);
+	if (ret < 0 || ret >= sizeof(unit))
+		return -ENAMETOOLONG;
+
+	return systemd_unit_interface("StartUnit", unit);
+}
+
+static int systemd_stop_service(const char *service_name)
+{
+	char unit[MAX_SERVICE_NAME];
+	int ret;
+
+	ret = snprintf(unit, sizeof(unit), "%s" SYSTEMD_SERVICE_SUFFIX,
+		       service_name);
+	if (ret < 0 || ret >= sizeof(unit))
+		return -ENAMETOOLONG;
+
+	return systemd_unit_interface("StopUnit", unit);
+}
+
 static int get_int_from_file(char *path, int *_val)
 {
 	char buf[INT_BUF_SIZE];
@@ -524,14 +582,71 @@ static int legacy_reconfigure_gadget(struct usb_client *usb,
 
 static int legacy_enable(struct usb_client *usb)
 {
-	return sys_set_str(LEGACY_ENABLE_PATH,
+	int ret;
+	int i;
+	struct usb_gadget *gadget;
+	struct usb_function_with_service *fws;
+
+	ret = sys_set_str(LEGACY_ENABLE_PATH,
 			   LEGACY_ENABLE);
+	if (ret < 0)
+		return ret;
+
+	ret = legacy_get_current_gadget(usb, &gadget);
+	if (ret < 0)
+		goto disable_gadget;
+
+	for (i = 0; gadget->funcs[i]; ++i) {
+		if (gadget->funcs[i]->function_group !=
+		    USB_FUNCTION_GROUP_WITH_SERVICE)
+			continue;
+
+		fws = container_of(gadget->funcs[i],
+				   struct usb_function_with_service, func);
+		ret = systemd_start_service(fws->service);
+		if (ret < 0)
+			goto stop_services;
+	}
+
+	return 0;
+stop_services:
+	while (--i >= 0) {
+		if (gadget->funcs[i]->function_group !=
+		    USB_FUNCTION_GROUP_WITH_SERVICE)
+			continue;
+
+		fws = container_of(gadget->funcs[i],
+				   struct usb_function_with_service, func);
+		systemd_stop_service(fws->service);
+	}
+
+disable_gadget:
+	sys_set_str(LEGACY_ENABLE_PATH, LEGACY_DISABLE);
+	return ret;
 }
 
 static int legacy_disable(struct usb_client *usb)
 {
-	return sys_set_str(LEGACY_ENABLE_PATH,
-			   LEGACY_DISABLE);
+	int ret;
+	int i;
+	struct usb_gadget *gadget;
+	struct usb_function_with_service *fws;
+
+	ret = legacy_get_current_gadget(usb, &gadget);
+	if (ret < 0)
+		return ret;
+
+	for (i = 0; gadget->funcs[i]; ++i) {
+		if (gadget->funcs[i]->function_group != USB_FUNCTION_GROUP_WITH_SERVICE)
+			continue;
+
+		fws = container_of(gadget->funcs[i], struct usb_function_with_service, func);
+		ret = systemd_stop_service(fws->service);
+		if (ret < 0)
+			return ret;
+	}
+
+	return sys_set_str(LEGACY_ENABLE_PATH, LEGACY_DISABLE);
 }
 
 static void legacy_free_config(struct usb_configuration *config)
@@ -565,7 +680,7 @@ static void legacy_free_gadget(struct usb_gadget *gadget)
 	if (!gadget)
 		return;
 
-		if (gadget->strs) {
+	if (gadget->strs) {
 		for (i = 0; gadget->strs[i].lang_code; ++i) {
 			free(gadget->strs[i].manufacturer);
 			free(gadget->strs[i].product);
diff --git a/packaging/device-manager-plugin-artik.spec b/packaging/device-manager-plugin-artik.spec
index dda9808..5feaf0e 100755
--- a/packaging/device-manager-plugin-artik.spec
+++ b/packaging/device-manager-plugin-artik.spec
@@ -14,6 +14,8 @@ BuildRequires:  pkgconfig(hwcommon)
 BuildRequires:  pkgconfig(glib-2.0)
 BuildRequires:  pkgconfig(libudev)
 BuildRequires:  pkgconfig(capi-system-peripheral-io)
+BuildRequires:  pkgconfig(libusbgx)
+BuildRequires:  pkgconfig(libsystemd)
 
 %description
 Device manager plugin artik