diff --git a/Core/Src/Components/SSL_Display.cpp b/Core/Src/Components/SSL_Display.cpp index b0f65cb..72dd999 100644 --- a/Core/Src/Components/SSL_Display.cpp +++ b/Core/Src/Components/SSL_Display.cpp @@ -24,9 +24,9 @@ int32_t SSL_Display::init() { RobotStatus status0; for(uint32_t i = 0; i<12; i++){ status0.batteryLevel = ((float)i)/12; - status0.connected = true; + status0.connected = i%2; status0.robotId = i; - status0.status = 0; + status0.status = i%2; status0.team = i%2; robots[i].setRobotStatus(status0); } diff --git a/Core/Src/Components/SSL_GFX.cpp b/Core/Src/Components/SSL_GFX.cpp index ea95e94..5c3c909 100644 --- a/Core/Src/Components/SSL_GFX.cpp +++ b/Core/Src/Components/SSL_GFX.cpp @@ -31,10 +31,10 @@ int32_t SSL_GFX::draw() { uint8_t colorBoundingBox[3]; if(robotStatus.connected){ colorBoundingBox[0] = 0; - colorBoundingBox[1] = 0b11111100; + colorBoundingBox[1] = 0xFC; colorBoundingBox[2] = 0; }else{ - colorBoundingBox[0] = 0b11111100; + colorBoundingBox[0] = 0xFC; colorBoundingBox[1] = 0; colorBoundingBox[2] = 0; } @@ -43,8 +43,9 @@ int32_t SSL_GFX::draw() { errors += drawRobotSilhouette(colorRobot); errors += drawId(colorRobot); errors += drawBatteryBar(); - errors += drawRobotLid(); + errors += drawRobotLid(); errors += drawRobotTeam(); + errors += drawBall(); errors += hDisplay->setPosition(posX, posY, sizeX, sizeY); errors += hDisplay->write((uint8_t*)hBuffer, 19200); return errors; @@ -57,53 +58,29 @@ int32_t SSL_GFX::setRobotStatus(RobotStatus status) { // Private methods -int32_t SSL_GFX::drawText(uint8_t color[3], uint16_t posX, uint16_t posY, uint8_t* string, uint32_t size) { - if(posX+6*size > sizeX){ - // Out of bounds - return -1; - } - if(posY+6 > sizeY){ - // Out of bounds - return -1; - } - for(uint32_t i = 0; i>(j))&1){ - hBuffer[j+posY][k+posX][0] = color[0]; - hBuffer[j+posY][k+posX][1] = color[1]; - hBuffer[j+posY][k+posX][2] = color[2]; - }else{ - hBuffer[j+posY][k+posX][0] = 0; - hBuffer[j+posY][k+posX][1] = 0; - hBuffer[j+posY][k+posX][2] = 0; - } - } - } - posX += 6; - } - return 0; -} - int32_t SSL_GFX::drawBoundingBox(uint8_t color[3]) { for(uint32_t i=0; i