Add init_io_expander for Plankton board test

Set Plankton IO expander value to initialize switches and check
initialized settings.

BUG=chrome-os-partner:33362
TEST=manual

Change-Id: I1504fe94613be2f76001d35a30791f0d3336db90
Reviewed-on: https://chromium-review.googlesource.com/259432
Reviewed-by: Wai-Hong Tam <waihong@chromium.org>
Commit-Queue: Pin-chih Lin <johnylin@chromium.org>
Tested-by: Pin-chih Lin <johnylin@chromium.org>
diff --git a/server/cros/servo/plankton.py b/server/cros/servo/plankton.py
index 3453138..482e42b 100644
--- a/server/cros/servo/plankton.py
+++ b/server/cros/servo/plankton.py
@@ -53,6 +53,17 @@
         plankton_port = args_dict.get('plankton_port', self.DEFAULT_SERVO_PORT)
         remote = 'http://%s:%s' % (plankton_host, plankton_port)
         self._server = xmlrpclib.ServerProxy(remote)
+        self.init_io_expander()
+
+
+    def init_io_expander(self):
+        """Initializes Plankton IO expander register settings."""
+        if not int(self.get('debug_usb_sel')):
+            raise PlanktonError('debug_usb_sel (SW3) should be ON!! '
+                                'Please use CN15 to connect Plankton.')
+        self.set('typec_to_hub_sw', '0')
+        self.set('usb2_mux_sw', '1')
+        self.set('usb_dn_pwren', 'on')
 
 
     def set(self, control_name, value):