Diff: ard2pmod.cpp

Revision:

2:686912ed055f

Parent:

0:bb62cd328247

Child:

3:64d54fa4dd3c

--- a/ard2pmod.cpp	Thu Nov 20 22:18:34 2014 +0000
+++ b/ard2pmod.cpp	Fri Nov 21 04:39:49 2014 +0000
@@ -77,19 +77,10 @@
 Max14661(ARD2PMOD_SDA, ARD2PMOD_SCL, MAX14661_I2C_ADRS0), 
 Ds3231(ARD2PMOD_SDA, ARD2PMOD_SCL)
 {
-    uint8_t mux_data[4];
-    
     switch(pmod_type)
     {
         case PMOD_TYPE_I2C:
-            mux_data[0] = SW07;
-            mux_data[1] = ((SW12 | SW09) >> 8);
-            mux_data[2] = SW08;
-            mux_data[3] = ((SW11 | SW10) >> 8);
-            
-            wrt_shadow_registers(mux_data);
-            wrt_cmd_registers(C0PY_SHADOW, C0PY_SHADOW);
-            
+            set_switches((SW12 | SW09 | SW07), (SW11 | SW10 | SW08));
             break;
             
         case PMOD_TYPE_1_GPIO:
@@ -101,25 +92,11 @@
             break;
             
         case PMOD_TYPE_3_UART:
-            mux_data[0] = SW02;
-            mux_data[1] = (SW12 >> 8);
-            mux_data[2] = SW01;
-            mux_data[3] = (SW11 >> 8);
-            
-            wrt_shadow_registers(mux_data);
-            wrt_cmd_registers(C0PY_SHADOW, C0PY_SHADOW);
-            
+            set_switches((SW12 | SW02), (SW11 | SW01));
             break;
             
         case PMOD_TYPE_4_UART:
-            mux_data[0] = SW01;
-            mux_data[1] = (SW13 >> 8);
-            mux_data[2] = SW02;
-            mux_data[3] = (SW12 >> 8);
-            
-            wrt_shadow_registers(mux_data);
-            wrt_cmd_registers(C0PY_SHADOW, C0PY_SHADOW);
-            
+            set_switches((SW13 | SW01), (SW12 | SW02));
             break;
             
         case PMOD_TYPE_5_HBRIDGE: