greybus: svc: create bidirectional routes on hotplug request
Upon receiving a hotplug request, we need to prepare the routing table
to allow packets to flow between the AP interface and the newly detected
interface.
Tested-by: Viresh Kumar <viresh.kumar@linaro.org>
Reviewed-by: Viresh Kumar <viresh.kumar@linaro.org>
Signed-off-by: Perry Hung <perry@leaflabs.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@google.com>
diff --git a/drivers/staging/greybus/svc.c b/drivers/staging/greybus/svc.c
index f332129..3d18087 100644
--- a/drivers/staging/greybus/svc.c
+++ b/drivers/staging/greybus/svc.c
@@ -309,6 +309,25 @@
goto ida_put;
}
+ /*
+ * Create a two-way route between the AP and the new interface
+ */
+ ret = route_create_operation(svc, hd->endo->ap_intf_id,
+ GB_DEVICE_ID_AP, intf_id, device_id);
+ if (ret) {
+ dev_err(dev, "%s: Route create operation failed, interface %hhu device_id %hhu (%d)\n",
+ __func__, intf_id, device_id, ret);
+ goto ida_put;
+ }
+
+ ret = route_create_operation(svc, intf_id, device_id,
+ hd->endo->ap_intf_id, GB_DEVICE_ID_AP);
+ if (ret) {
+ dev_err(dev, "%s: Route create operation failed, interface %hhu device_id %hhu (%d)\n",
+ __func__, intf_id, device_id, ret);
+ goto ida_put;
+ }
+
ret = gb_interface_init(intf, device_id);
if (ret) {
dev_err(dev, "%s: Failed to initialize interface, interface %hhu device_id %hhu (%d)\n",