Dependencies: TCS3200 X_NUCLEO_53L0A1 mbed
Revision 0:dd84da3761e1, committed 2018-03-23
- Comitter:
- kenken0721
- Date:
- Fri Mar 23 13:36:00 2018 +0000
- Commit message:
Changed in this revision
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/TCS3200.lib Fri Mar 23 13:36:00 2018 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/kenken0721/code/TCS3200/#40b638b93be8
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/X_NUCLEO_53L0A1.lib Fri Mar 23 13:36:00 2018 +0000 @@ -0,0 +1,1 @@ +http://os.mbed.com/teams/ST/code/X_NUCLEO_53L0A1/#99c367e8a402
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Fri Mar 23 13:36:00 2018 +0000
@@ -0,0 +1,57 @@
+#include "mbed.h"
+#include "XNucleo53L0A1.h"
+#include "TCS3200.h"
+#include <stdio.h>
+
+#define VL53L0_I2C_SDA D4
+#define VL53L0_I2C_SCL D5
+
+#define NOT_RECEIVE 0
+#define RED_RECEIVE 1
+#define BLUE_RECEIVE 2
+#define YELLOW_RECIEVE 3
+
+
+TCS3200 color(PB_5, PB_2, PC_4);//カラーセンサ
+static XNucleo53L0A1 *board=NULL;
+int count = 0;
+int red_count = 0;
+int blue_count = 0;
+int mode = NOT_RECEIVE;
+
+int main(){
+ long red, green, blue, clear;
+ int status;
+ uint32_t distance;
+ DevI2C *device_i2c = new DevI2C(VL53L0_I2C_SDA, VL53L0_I2C_SCL);
+ board = XNucleo53L0A1::instance(device_i2c, A2, D8, D2);
+ status = board->init_board();
+ if (status) {
+ printf("Failed to init board!\r\n");
+ return 0;
+ }
+ while (1) {
+ status = board->sensor_centre->get_distance(&distance);
+ red = color.ReadRed();
+ blue = color.ReadBlue();
+ clear = color.ReadClear();
+ if(clear <= 30 && distance <= 1000){
+ count++;
+ }
+ if(count >= 1000){
+ if(red <= 40 && green >= 80 && blue >= 70){
+ red_count++;
+ }else if(red >= 80 && green >= 60 && blue <= 40){
+ blue_count++;
+ }
+ count = 0;
+ }
+ if(red_count >= 1000 && distance >= 2000){
+ mode = RED_RECEIVE;
+ red_count = 0;
+ }else if(blue_count >= 1000 && distance >= 2000){
+ mode = BLUE_RECEIVE;
+ blue_count = 0;
+ }
+ }
+}
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed.bld Fri Mar 23 13:36:00 2018 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/mbed_official/code/mbed/builds/994bdf8177cb \ No newline at end of file