diff --git a/chips/tsb/src/tsb_unipro.c b/chips/tsb/src/tsb_unipro.c
index eef497e7db7a..054322cad283 100644
--- a/chips/tsb/src/tsb_unipro.c
+++ b/chips/tsb/src/tsb_unipro.c
@@ -51,7 +51,7 @@ typedef char ___cport_num_test[(CPORT_MAX <=
  * CPort Reset Proceedure, implemented according to section 5.7.8.5
  * from ARA_ES3_APBridge_rev091.pdf
  */
-static int tsb_unipro_reset_cport(uint32_t cportid) {
+int tsb_unipro_reset_cport(uint32_t cportid) {
     int rc;
     uint32_t tx_reset_offset, rx_reset_offset;
     uint32_t tx_queue_empty_offset, tx_queue_empty_bit;
diff --git a/common/src/gbcore.c b/common/src/gbcore.c
index 6f9272f85f76..491008278576 100644
--- a/common/src/gbcore.c
+++ b/common/src/gbcore.c
@@ -226,6 +226,15 @@ static int gbctrl_disconnected(uint32_t cportid,
                                0);
 }

+int tsb_unipro_reset_cport(uint32_t cportid);
+static int gbctrl_intf_mode_switch(uint32_t cportid,
+                                   gb_operation_header *op_header) {
+    tsb_unipro_reset_cport(CONTROL_CPORT);
+    jump_to_image();
+    /* should never reach here */
+    return 0;
+}
+
 static greybus_op_handler *handler_table[CPORT_MAX];

 int common_cport_handler(uint32_t cportid,
@@ -288,6 +297,7 @@ static greybus_op_handler control_cport_handlers[] = {
     {GB_CTRL_OP_CONNECTED, gbctrl_connected},
     {GB_CTRL_OP_DISCONNECTED, gbctrl_disconnected},
     {GB_CTRL_OP_INTERFACE_VERSION, gbctrl_get_interface_version},
+    {0xe, gbctrl_intf_mode_switch},
     {HANDLER_TABLE_END, NULL}
 };