Kyle Chiang / Mbed 2 deprecated TestColorSensor

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   m3pi mbed

main.cpp@2:5c0159599726, 2013-11-21 (annotated)

Committer:
TaintedTruth
Date:
Thu Nov 21 00:13:13 2013 +0000
Revision:
2:5c0159599726
Parent:
1:d481b2912c2a
Child:
3:b3c41c85fb1e
testing stuff

Who changed what in which revision?

UserRevisionLine numberNew contents of line
TaintedTruth 0:1eada136b388 1 #include "mbed.h"
TaintedTruth 0:1eada136b388 2 #include "m3pi.h"
TaintedTruth 0:1eada136b388 3
TaintedTruth 0:1eada136b388 4 DigitalOut sensorLED(p8);
TaintedTruth 0:1eada136b388 5 I2C colorSensor(p28, p27);
TaintedTruth 2:5c0159599726 6 Serial bt(p13, p14); // tx, rx
TaintedTruth 0:1eada136b388 7
TaintedTruth 0:1eada136b388 8 const int addr = 0x74;
TaintedTruth 1:d481b2912c2a 9 m3pi m3pi;
TaintedTruth 1:d481b2912c2a 10
TaintedTruth 2:5c0159599726 11 int read(char lowByteRegister) {
TaintedTruth 2:5c0159599726 12 char cmd[1];
TaintedTruth 2:5c0159599726 13 char echo[1];
TaintedTruth 2:5c0159599726 14 bt.printf("E:%0x ",echo[0]);
TaintedTruth 1:d481b2912c2a 15
TaintedTruth 2:5c0159599726 16 cmd[0] = lowByteRegister;
TaintedTruth 2:5c0159599726 17 colorSensor.write(addr,cmd,1);
TaintedTruth 2:5c0159599726 18 colorSensor.read(addr,echo,1);
TaintedTruth 2:5c0159599726 19 int result_low = (int) echo[0];
TaintedTruth 2:5c0159599726 20 bt.printf("lo:%0x ",result_low);
TaintedTruth 2:5c0159599726 21
TaintedTruth 2:5c0159599726 22 /*
TaintedTruth 2:5c0159599726 23 cmd[0] = lowByteRegister + 1;
TaintedTruth 2:5c0159599726 24 colorSensor.write(addr,cmd,1);
TaintedTruth 2:5c0159599726 25 colorSensor.read(addr,echo,1);
TaintedTruth 2:5c0159599726 26 int result_high = (int) echo[0];
TaintedTruth 2:5c0159599726 27 bt.printf("hi:%0x ",result_high);
TaintedTruth 2:5c0159599726 28
TaintedTruth 2:5c0159599726 29 return (result_high << 8) | result_low;
TaintedTruth 2:5c0159599726 30 */
TaintedTruth 2:5c0159599726 31
TaintedTruth 2:5c0159599726 32 return result_low;
TaintedTruth 2:5c0159599726 33 }
TaintedTruth 0:1eada136b388 34
TaintedTruth 0:1eada136b388 35 int main() {
TaintedTruth 0:1eada136b388 36
TaintedTruth 2:5c0159599726 37 bt.baud(115200);
TaintedTruth 2:5c0159599726 38
TaintedTruth 1:d481b2912c2a 39 char cmd[2];
TaintedTruth 2:5c0159599726 40 sensorLED = 1;
TaintedTruth 1:d481b2912c2a 41 m3pi.locate(0,1);
TaintedTruth 1:d481b2912c2a 42 m3pi.printf("Start");
TaintedTruth 1:d481b2912c2a 43 wait(1);
TaintedTruth 0:1eada136b388 44
TaintedTruth 0:1eada136b388 45 while(1) {
TaintedTruth 1:d481b2912c2a 46 cmd[0] = 0x00;
TaintedTruth 1:d481b2912c2a 47 cmd[1] = 0x01;
TaintedTruth 1:d481b2912c2a 48 colorSensor.write(addr,cmd,2);
TaintedTruth 1:d481b2912c2a 49
TaintedTruth 2:5c0159599726 50 int red = read(0x06);
TaintedTruth 2:5c0159599726 51 // int green = read(0x42);
TaintedTruth 2:5c0159599726 52 // int blue = read(0x44);
TaintedTruth 0:1eada136b388 53
TaintedTruth 0:1eada136b388 54 // Print for debugging
TaintedTruth 0:1eada136b388 55
TaintedTruth 2:5c0159599726 56 bt.printf("R:%0x ",red);
TaintedTruth 2:5c0159599726 57 //bt.printf("G:%0x ",green);
TaintedTruth 2:5c0159599726 58 //bt.printf("B:%0x ",blue);
TaintedTruth 2:5c0159599726 59 wait(1);
TaintedTruth 2:5c0159599726 60
TaintedTruth 2:5c0159599726 61 /*
TaintedTruth 2:5c0159599726 62 cmd[0] = 0x06;
TaintedTruth 2:5c0159599726 63 colorSensor.write(addr,cmd,1);
TaintedTruth 2:5c0159599726 64 colorSensor.read(addr,cmd,1);
TaintedTruth 2:5c0159599726 65 red = cmd[0];
TaintedTruth 0:1eada136b388 66
TaintedTruth 2:5c0159599726 67 cmd[0] = 0x07;
TaintedTruth 2:5c0159599726 68 colorSensor.write(addr,cmd,1);
TaintedTruth 2:5c0159599726 69 colorSensor.read(addr,cmd,1);
TaintedTruth 2:5c0159599726 70 green = cmd[0];
TaintedTruth 2:5c0159599726 71
TaintedTruth 2:5c0159599726 72 cmd[0] = 0x08;
TaintedTruth 2:5c0159599726 73 colorSensor.write(addr,cmd,1);
TaintedTruth 2:5c0159599726 74 colorSensor.read(addr,cmd,1);
TaintedTruth 2:5c0159599726 75 blue = cmd[0];
TaintedTruth 2:5c0159599726 76
TaintedTruth 2:5c0159599726 77 bt.printf("Rc:%d ",red);
TaintedTruth 2:5c0159599726 78 bt.printf("Gc:%d ",green);
TaintedTruth 2:5c0159599726 79 bt.printf("Bc:%d ",blue);
TaintedTruth 2:5c0159599726 80 */
TaintedTruth 2:5c0159599726 81
TaintedTruth 2:5c0159599726 82 /*
TaintedTruth 1:d481b2912c2a 83 m3pi.cls();
TaintedTruth 1:d481b2912c2a 84 m3pi.locate(0,1);
TaintedTruth 0:1eada136b388 85 m3pi.printf("R:%d",red);
TaintedTruth 0:1eada136b388 86 wait(1.5);
TaintedTruth 1:d481b2912c2a 87
TaintedTruth 1:d481b2912c2a 88 m3pi.cls();
TaintedTruth 1:d481b2912c2a 89 m3pi.locate(0,1);
TaintedTruth 0:1eada136b388 90 m3pi.printf("G:%d",green);
TaintedTruth 0:1eada136b388 91 wait(1.5);
TaintedTruth 1:d481b2912c2a 92
TaintedTruth 1:d481b2912c2a 93 m3pi.cls();
TaintedTruth 1:d481b2912c2a 94 m3pi.locate(0,1);
TaintedTruth 0:1eada136b388 95 m3pi.printf("B:%d",blue);
TaintedTruth 0:1eada136b388 96 wait(1.5);
TaintedTruth 2:5c0159599726 97 */
TaintedTruth 0:1eada136b388 98 }
TaintedTruth 0:1eada136b388 99 }