external i2c

Author: gbr1

src/Arduino_Robot_Firmware.cpp

@@ -49,6 +49,8 @@ int Arduino_Robot_Firmware::begin(){
 
     beginAPDS();
     beginServo();
+    beginI2Cselect();
+    connectExternalI2C();
 
     return 0;
 }
@@ -120,4 +122,24 @@ void Arduino_Robot_Firmware::setServoA(int position){
 
 void Arduino_Robot_Firmware::setServoB(int position){
     servo_B->write(position);
+}
+
+/******************************************************************************************************/
+/*                                        RC Servo A & B                                              */
+/******************************************************************************************************/
+
+int Arduino_Robot_Firmware::beginI2Cselect(){
+    pinMode(SELECT_I2C_BUS,OUTPUT);
+}
+
+void Arduino_Robot_Firmware::setExternalI2C(uint8_t state){
+    digitalWrite(SELECT_I2C_BUS,state);
+}
+
+void Arduino_Robot_Firmware::connectExternalI2C(){
+    setExternalI2C(LOW);
+}
+
+void Arduino_Robot_Firmware::disconnectExternalI2C(){
+    setExternalI2C(HIGH);
 }

src/Arduino_Robot_Firmware.h

@@ -50,8 +50,15 @@ class Arduino_Robot_Firmware{
 
         // Servo
         int beginServo();                           // initialize Servo interfaces
-        void setServoA(int position);              // 0°-180° servo position
-        void setServoB(int position);              // 0°-180° servo position
+        void setServoA(int position);               // 0°-180° servo position
+        void setServoB(int position);               // 0°-180° servo position
+
+
+        // I2C select
+        int beginI2Cselect();                       // initialize I2C bus selector
+        void setExternalI2C(uint8_t state);         // set A4,A5 connection on I2C bus 2
+        void connectExternalI2C();                  // allow A4,A5 on nano connector to be attached to I2C bus 2
+        void disconnectExternalI2C();               // disable the connection on A4,A5
 };
 
 #endif

src/pinout_definitions.h

@@ -44,8 +44,11 @@
 #define APDS_LED PB6
 #define APDS_INT PC10
 
+// I2C ports
 #define I2C_1_SDA PB7
 #define I2C_1_SCL PB8
+#define SELECT_I2C_BUS PB2
+