library for the motor driver

Dependents:   4180_final_project

Fork of libTCS34725 by Michael Wilkens

Revision:
3:afb107db7994
Parent:
2:cc2c0831a763
--- a/TCS34725.cpp	Wed Jan 25 19:25:28 2017 +0000
+++ b/TCS34725.cpp	Wed Jan 25 20:17:57 2017 +0000
@@ -1,17 +1,15 @@
 #include "TCS34725.h"
 
-I2C i2c(SDA, SCL);
+TCS34725::TCS34725() : i2c(SDA,SCL) {}
+TCS34725::TCS34725(PinName i2c_sda, PinName i2c_scl) : i2c(i2c_sda,i2c_scl) {}
 
-uint8_t t_intTime;
-uint8_t t_gain;
-
-void i2cWrite8(uint8_t addr, char reg, char data){
+void TCS34725::i2cWrite8(uint8_t addr, char reg, char data){
     char packet[2] = {reg | COMMAND_BIT ,data & 0xFF}; 
     i2c.write(addr,packet,2,false);
     wait(0.01);
 }
 
-uint8_t i2cRead8(uint8_t addr, char reg){
+uint8_t TCS34725::i2cRead8(uint8_t addr, char reg){
     char packet[1] = {reg | COMMAND_BIT};
     char data[1] = {0};
     i2c.write(addr,packet,1, true);
@@ -19,7 +17,7 @@
     return (uint8_t)data[0];
 }
 
-uint16_t i2cRead16(uint8_t addr, char reg){
+uint16_t TCS34725::i2cRead16(uint8_t addr, char reg){
     char packet[1] = {reg | COMMAND_BIT};
     char data[2] = {0,0};
     i2c.write(addr,packet,1, true);
@@ -27,7 +25,7 @@
     return ((uint16_t)data[1] << 8) | (uint16_t)data[0];
 }
 
-bool TCS34725_init(char intTime, char gain){
+bool TCS34725::init(char intTime, char gain){
     i2c.frequency(400000);
     
     uint8_t id = i2cRead8(SENSOR_ADDR, TCS34725_ID);
@@ -43,13 +41,13 @@
     return true;
 }
 
-void TCS34725_config(char intTime, char gain){
+void TCS34725::config(char intTime, char gain){
     uint8_t reg = i2cRead8(SENSOR_ADDR, TCS34725_ENABLE);
     i2cWrite8(SENSOR_ADDR,TCS34725_ENABLE, reg | ~(TCS34725_ENABLE_PON | TCS34725_ENABLE_AEN));
-    TCS34725_init(intTime,gain);
+    init(intTime,gain);
 }
 
-void TCS34725_getColor(uint16_t *r, uint16_t *g, uint16_t *b, uint16_t *c){
+void TCS34725::getColor(uint16_t *r, uint16_t *g, uint16_t *b, uint16_t *c){
     *c = i2cRead16(SENSOR_ADDR, TCS34725_CDATAL);
     *r = i2cRead16(SENSOR_ADDR, TCS34725_RDATAL);
     *g = i2cRead16(SENSOR_ADDR, TCS34725_GDATAL);
@@ -76,7 +74,7 @@
     }
 }
 
-void TCS34725_DEBUG(Serial * deb){
+void TCS34725::DEBUG(Serial * deb){
     deb->printf("ATIME:%d ENABLE:%d CONTROL:%d ID:%d\n",
     i2cRead8(SENSOR_ADDR, TCS34725_ATIME),
     i2cRead8(SENSOR_ADDR, TCS34725_ENABLE),