/* HocLapTrinhRobot G2 07 - Thiet ke man hinh trang thai robot Board: ESP32-S3 DevKit Hardware: SHT31 I2C, LDR voltage divider, MQ-135 analog, SSD1306 OLED 128x64, LED, active buzzer */ #include enum StatusLevel { STATUS_OK, STATUS_WATCH, STATUS_ALERT }; const int PIN_I2C_SDA = 8; const int PIN_I2C_SCL = 9; const int PIN_LDR = 4; const int PIN_MQ135 = 6; const int PIN_LED = 2; const int PIN_BUZZER = 15; const uint8_t SHT31_ADDR = 0x44; const uint8_t OLED_ADDR = 0x3C; const unsigned long SAMPLE_INTERVAL_MS = 1000; const unsigned long MQ_WARMUP_MS = 60000; const float EMA_ALPHA = 0.18f; uint8_t oledBuffer[128 * 64 / 8]; int gasBaselineRaw = 1800; bool filtersReady = false; bool oledReady = false; unsigned long lastSampleMs = 0; float tempFiltered = 0.0f; float humFiltered = 0.0f; float lightFiltered = 0.0f; float airFiltered = 0.0f; StatusLevel currentStatus = STATUS_OK; uint8_t crc8(const uint8_t *data, int len) { uint8_t crc = 0xFF; for (int i = 0; i < len; i++) { crc ^= data[i]; for (int bit = 0; bit < 8; bit++) { crc = (crc & 0x80) ? (crc << 1) ^ 0x31 : (crc << 1); } } return crc; } bool readSht31(float &temperatureC, float &humidityPercent) { Wire.beginTransmission(SHT31_ADDR); Wire.write(0x24); Wire.write(0x00); if (Wire.endTransmission() != 0) return false; delay(20); if (Wire.requestFrom((int)SHT31_ADDR, 6) != 6) return false; uint8_t data[6]; for (int i = 0; i < 6; i++) data[i] = Wire.read(); if (crc8(data, 2) != data[2] || crc8(data + 3, 2) != data[5]) return false; uint16_t rawTemp = ((uint16_t)data[0] << 8) | data[1]; uint16_t rawHum = ((uint16_t)data[3] << 8) | data[4]; temperatureC = -45.0f + 175.0f * ((float)rawTemp / 65535.0f); humidityPercent = 100.0f * ((float)rawHum / 65535.0f); return true; } int readAnalogAverage(int pin, int sampleCount) { long total = 0; for (int i = 0; i < sampleCount; i++) { total += analogRead(pin); delay(2); } return total / sampleCount; } float constrainFloat(float value, float low, float high) { if (value < low) return low; if (value > high) return high; return value; } float lightPercentFromRaw(int raw) { return constrainFloat((raw / 4095.0f) * 100.0f, 0.0f, 100.0f); } float airScoreFromRaw(int raw) { return constrainFloat((raw - gasBaselineRaw) / 12.0f, 0.0f, 100.0f); } float updateEma(float previous, float sample, bool initialized) { if (!initialized) return sample; return previous + EMA_ALPHA * (sample - previous); } bool i2cDevicePresent(uint8_t address) { Wire.beginTransmission(address); return Wire.endTransmission() == 0; } void oledCommand(uint8_t command) { Wire.beginTransmission(OLED_ADDR); Wire.write(0x00); Wire.write(command); Wire.endTransmission(); } void oledClear() { for (int i = 0; i < 1024; i++) oledBuffer[i] = 0; } void oledFlush() { if (!oledReady) return; for (uint8_t page = 0; page < 8; page++) { oledCommand(0xB0 + page); oledCommand(0x00); oledCommand(0x10); for (int start = 0; start < 128; start += 16) { Wire.beginTransmission(OLED_ADDR); Wire.write(0x40); for (int i = 0; i < 16; i++) { Wire.write(oledBuffer[page * 128 + start + i]); } Wire.endTransmission(); } } } void setPixel(int x, int y, bool on) { if (x < 0 || x >= 128 || y < 0 || y >= 64) return; int index = x + (y / 8) * 128; uint8_t mask = 1 << (y & 7); if (on) { oledBuffer[index] |= mask; } else { oledBuffer[index] &= ~mask; } } void fillRect(int x, int y, int w, int h, bool on) { for (int yy = y; yy < y + h; yy++) { for (int xx = x; xx < x + w; xx++) { setPixel(xx, yy, on); } } } void drawFrame(int x, int y, int w, int h) { fillRect(x, y, w, 1, true); fillRect(x, y + h - 1, w, 1, true); fillRect(x, y, 1, h, true); fillRect(x + w - 1, y, 1, h, true); } bool oledInit() { if (!i2cDevicePresent(OLED_ADDR)) return false; delay(50); oledCommand(0xAE); oledCommand(0xD5); oledCommand(0x80); oledCommand(0xA8); oledCommand(0x3F); oledCommand(0xD3); oledCommand(0x00); oledCommand(0x40); oledCommand(0x8D); oledCommand(0x14); oledCommand(0x20); oledCommand(0x00); oledCommand(0xA1); oledCommand(0xC8); oledCommand(0xDA); oledCommand(0x12); oledCommand(0x81); oledCommand(0xCF); oledCommand(0xD9); oledCommand(0xF1); oledCommand(0xDB); oledCommand(0x40); oledCommand(0xA4); oledCommand(0xA6); oledCommand(0xAF); oledClear(); oledFlush(); return true; } StatusLevel chooseStatus(float tempC, float humidity, float lightPercent, float airScore) { bool gasReady = millis() >= MQ_WARMUP_MS; if (tempC > 34.0f || humidity > 85.0f || lightPercent < 15.0f || (gasReady && airScore > 60.0f)) { return STATUS_ALERT; } if (tempC > 32.0f || humidity > 78.0f || lightPercent < 25.0f || (gasReady && airScore > 45.0f)) { return STATUS_WATCH; } return STATUS_OK; } const char *statusName(StatusLevel status) { if (status == STATUS_ALERT) return "ALERT"; if (status == STATUS_WATCH) return "WATCH"; return "OK"; } void drawStatusHeader(StatusLevel status) { drawFrame(0, 0, 128, 20); if (status == STATUS_OK) { fillRect(4, 4, 24, 12, true); fillRect(34, 8, 88, 4, true); } else if (status == STATUS_WATCH) { fillRect(4, 4, 12, 12, true); fillRect(22, 4, 12, 12, true); fillRect(42, 6, 78, 8, true); fillRect(46, 8, 70, 4, false); } else { fillRect(0, 0, 128, 20, true); fillRect(8, 4, 112, 12, false); fillRect(12, 7, 104, 6, true); } } void drawMiniBar(int y, float valuePercent) { drawFrame(4, y, 120, 7); int width = (int)(constrainFloat(valuePercent, 0.0f, 100.0f) * 1.16f); fillRect(6, y + 2, width, 3, true); } void drawHeartbeat() { int heartbeatX = 10 + (millis() / 120) % 108; fillRect(heartbeatX, 14, 4, 4, true); } void drawStatusScreen(StatusLevel status, float tempC, float humidity, float lightPercent, float airScore) { oledClear(); drawStatusHeader(status); drawHeartbeat(); float tempPercent = constrainFloat((tempC - 15.0f) * 4.0f, 0.0f, 100.0f); drawMiniBar(23, tempPercent); drawMiniBar(33, humidity); drawMiniBar(43, lightPercent); drawMiniBar(53, airScore); oledFlush(); } void calibrateGasBaseline() { gasBaselineRaw = readAnalogAverage(PIN_MQ135, 40); Serial.print("baseline_gas_raw="); Serial.println(gasBaselineRaw); } void handleSerialCommand() { if (!Serial.available()) return; String command = Serial.readStringUntil('\n'); command.trim(); command.toUpperCase(); if (command == "BASELINE GAS") { calibrateGasBaseline(); } else if (command == "RESET FILTER") { filtersReady = false; Serial.println("filters_reset=OK"); } else if (command == "STATUS") { Serial.print("status="); Serial.print(statusName(currentStatus)); Serial.print(" baseline="); Serial.println(gasBaselineRaw); } else if (command.length() > 0) { Serial.println("commands: BASELINE GAS | RESET FILTER | STATUS"); } } void updateLedBuzzer(StatusLevel status) { if (status == STATUS_ALERT) { digitalWrite(PIN_LED, HIGH); digitalWrite(PIN_BUZZER, ((millis() / 180) % 2 == 0) ? HIGH : LOW); } else if (status == STATUS_WATCH) { digitalWrite(PIN_LED, ((millis() / 600) % 2 == 0) ? HIGH : LOW); digitalWrite(PIN_BUZZER, LOW); } else { digitalWrite(PIN_LED, LOW); digitalWrite(PIN_BUZZER, LOW); } } void setup() { Serial.begin(115200); delay(400); pinMode(PIN_LED, OUTPUT); pinMode(PIN_BUZZER, OUTPUT); digitalWrite(PIN_LED, LOW); digitalWrite(PIN_BUZZER, LOW); analogReadResolution(12); Wire.begin(PIN_I2C_SDA, PIN_I2C_SCL); oledReady = oledInit(); Serial.println("G2 07 status screen ready"); Serial.println("commands: BASELINE GAS | RESET FILTER | STATUS"); } void loop() { handleSerialCommand(); updateLedBuzzer(currentStatus); unsigned long now = millis(); if (now - lastSampleMs < SAMPLE_INTERVAL_MS) { if (oledReady) { drawStatusScreen(currentStatus, tempFiltered, humFiltered, lightFiltered, airFiltered); } return; } lastSampleMs = now; float tempRaw = tempFiltered; float humRaw = humFiltered; bool shtOk = readSht31(tempRaw, humRaw); if (!shtOk && !filtersReady) { tempRaw = 0.0f; humRaw = 0.0f; } int ldrRaw = readAnalogAverage(PIN_LDR, 12); int mqRaw = readAnalogAverage(PIN_MQ135, 12); float lightRaw = lightPercentFromRaw(ldrRaw); float airRaw = airScoreFromRaw(mqRaw); tempFiltered = updateEma(tempFiltered, tempRaw, filtersReady); humFiltered = updateEma(humFiltered, humRaw, filtersReady); lightFiltered = updateEma(lightFiltered, lightRaw, filtersReady); airFiltered = updateEma(airFiltered, airRaw, filtersReady); filtersReady = true; currentStatus = chooseStatus(tempFiltered, humFiltered, lightFiltered, airFiltered); updateLedBuzzer(currentStatus); if (oledReady) { drawStatusScreen(currentStatus, tempFiltered, humFiltered, lightFiltered, airFiltered); } Serial.print("t_ms="); Serial.print(now); Serial.print(" oled="); Serial.print(oledReady ? "OK" : "ERR"); Serial.print(" sht="); Serial.print(shtOk ? "OK" : "ERR"); Serial.print(" status="); Serial.print(statusName(currentStatus)); Serial.print(" temp="); Serial.print(tempFiltered, 1); Serial.print(" hum="); Serial.print(humFiltered, 1); Serial.print(" light="); Serial.print(lightFiltered, 1); Serial.print(" air="); Serial.println(airFiltered, 1); }

Thiết kế màn hình trạng thái robot

Đăng nhập để học miễn phí