EmaMaker
/
SPQR-Team1-2020
1
1
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

working camera->teensy transimission protocol

code_midgen
EmaMaker 2020-01-22 17:22:32 +01:00
parent 13134cac99
commit d534c5b4a8
3 changed files with 17 additions and 22 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

17
src/data_source_camera.cpp
View File

@ -12,21 +12,21 @@ void DataSourceCamera :: readSensor(){
count=0;
}
else if(value==endp){
end=true;
start=false;
data_received=false;
if(count==3 && start==true) {
if(count==4 && start==true) {
data_received=true;
true_xb = xb;
true_yb = yb;
true_xy = xy;
true_yy = yy;
}
end=true;
start=false;
}else{
if(start==true){
if (count==0) xb=value;
else if (count==1) xy=value;
else if (count==2) yb=value;
else if (count==1) yb=value;
else if (count==2) xy=value;
else if (count==3) yy=value;
count++;
}
@ -186,13 +186,6 @@ void DataSourceCamera::test(){
DEBUG.print(" | ");
DEBUG.println(fixCamIMU(pDef)); */
//update();
DEBUG.print(xb);
DEBUG.print("|");
DEBUG.print(yb);
DEBUG.print("|");
DEBUG.print(xy);
DEBUG.print("|");
DEBUG.print(yy);
DEBUG.println("---------------");
DEBUG.print(true_xb);
DEBUG.print("|");

13
src/main.cpp
View File

@ -6,7 +6,7 @@
void setup() {
delay(500);
DEBUG.begin(9600);
DEBUG.begin(19600);
initSensors();
initGames();
@ -16,11 +16,12 @@ void setup() {
void loop() {
updateSensors();
camera->test();
/*
goalie->play(role==1);
keeper->play(role==0); */
// goalie->play(role==1);
// keeper->play(role==0);
// Last thing to do: movement
/* drive->drivePrepared(); */
// drive->drivePrepared();
//Serial.print("ao");
camera->test();
}

9
utility/OpenMV/conic_eff.py
View File

@ -39,8 +39,8 @@ blue_led.on()
thresholds = [ (69, 100, -12, 11, 15, 89), # thresholds yellow goal
(20, 51, -23, 26, -69, -31)] # thresholds blue goal (6, 31, -15, 4, -35, 0)
thresholds = [ (60, 75, -19, 9, 9, 60), # thresholds yellow goal
(16, 35, -8, 24, -41, -13)] # thresholds blue goal (6, 31, -15, 4, -35, 0)
roi = (0, 6, 318, 152)
@ -64,7 +64,7 @@ sensor.set_contrast(+0)
sensor.set_saturation(+0)
sensor.set_brightness(0)
sensor.set_quality(0)
sensor.set_auto_exposure(False, 8000)
sensor.set_auto_exposure(False, 3500)
sensor.set_auto_gain(True)
sensor.skip_frames(time = 300)
@ -125,7 +125,7 @@ while(True):
if b_found == True:
b_cx = val_map(b_cx, -img.width() / 2, img.width() / 2, 0, 100)
b_cx = val_map(b_cy, -img.height() / 2, img.height() / 2, 0, 100)
b_cy = val_map(b_cy, -img.height() / 2, img.height() / 2, 0, 100)
#Prepare for send as a list of characters
s_bcx = chr(b_cx)
@ -139,6 +139,7 @@ while(True):
#print(str(y_cx) + " | " + str(y_cy) + " --- " + str(b_cx) + " | " + str(b_cy))
uart.write(START_BYTE)
uart.write(s_ycx)
uart.write(s_ycy)