Dependents:   RobotBase

Revision:
0:91d31b26ae9e
Child:
1:48028dcad4e2
diff -r 000000000000 -r 91d31b26ae9e Robot.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Robot.cpp	Thu Jul 02 00:58:51 2015 +0000
@@ -0,0 +1,28 @@
+#include "mbed.h"
+#include "Robot.h"
+#include "I2CDevice.h"
+
+Robot::Robot( int numOfI2CDevice ) : mNumOfI2CDevice( numOfI2CDevice ){
+}
+
+Robot::~Robot(){
+    delete[] mI2CDevice;
+}
+
+void Robot::update(){
+    readI2CDevice();
+    updateAction();
+    writeI2CDevice();
+}
+
+void Robot::writeI2CDevice(){
+    for ( int i = 0; i < mNumOfI2CDevice; ++i ){
+        mI2CDevice[ i ]->write();
+    }
+}
+
+void Robot::readI2CDevice(){
+    for ( int i = 0; i < mNumOfI2CDevice; ++i ){
+        mI2CDevice[ i ]->read();
+    }
+}
\ No newline at end of file