MatrixMiniR4.cpp

Go to the documentation of this file.

#include "MatrixMiniR4.h"
#include "Modules/MMLower.h"
 
MatrixMiniR4::MatrixMiniR4() {}

 
bool MatrixMiniR4::begin()
{
    MMLower::RESULT result = mmL.Init();
 
    LED.begin(7);
    LED.setColor(1, 0, 0, 0);
    LED.setColor(2, 0, 0, 0);
    Buzzer.begin(6);
 
    Motion.begin();
 
    while (!M1.begin());
    while (!M2.begin());
    while (!M3.begin());
    while (!M4.begin());
 
    RC1.begin();
    RC2.begin();
    RC3.begin();
    RC4.begin();
 
    OLED = Adafruit_SSD1306(128, 32, &Wire1, -1);
    OLED.begin(SSD1306_SWITCHCAPVCC, MATRIXMINIR4_OLED_ADDRESS);
    OLED.setTextColor(SSD1306_WHITE); //Default Color White
    OLED.clearDisplay();
    OLED.display();
 
    /* CLK: D3R(11) , CMD: D2R(4) , SET: D3L(12) , DAT: D2L(5) */
    PS2.config_gamepad(11, 4, 12, 5, false, false);
        
    //Check the Init is ok or not.
    if (result != MMLower::RESULT::OK) {
        OLED.setCursor(4, 8);
        OLED.setTextSize(2);
        OLED.print(F("Init Error"));
        OLED.display();
        
        while (true) {
            for (uint8_t i = 0; i < 3; i++) {
                Buzzer.Tone(700, 100);
                delay(100);
                Buzzer.NoTone();
                delay(100);
            }
            delay(3000);
        }
    }
    
    delay(200);
    //Check the FW version is outdated or not.
    String FWVersion_S;
    MMLower::RESULT resultFWCheck = mmL.GetFWVersion(FWVersion_S);
    if (resultFWCheck == MMLower::RESULT::OK) {
        uint8_t FWmajorVersion, FWminorVersion;
        uint8_t FWVersion_dotIndex = FWVersion_S.indexOf('.');
        if (FWVersion_dotIndex != -1) {
            FWmajorVersion = FWVersion_S.substring(0, FWVersion_dotIndex).toInt();
            FWminorVersion = FWVersion_S.substring(FWVersion_dotIndex + 1).toInt();
            if (FWmajorVersion < 6 || (FWmajorVersion == 6 && FWminorVersion < 0)) {
                for (uint8_t i = 0; i < 3; i++) {
                    Buzzer.Tone(550, 100);
                    delay(60);
                    Buzzer.NoTone();
                    delay(60);
                }
                
                unsigned long lastUpdate = millis();
                bool showFirst = true;
                OLED.clearDisplay();
                OLED.setTextSize(1);
                while (BTN_DOWN.getState() == false) {
                    if (millis() - lastUpdate >= 3000) {
                        lastUpdate = millis();
                        showFirst = !showFirst;
                    }
                    OLED.clearDisplay();
                    if (showFirst) {
                        OLED.setCursor(11, 5);
                        OLED.print(F("Firmware Outdated!"));
                        OLED.setCursor(11, 18);
                        OLED.print(F(" Required:  v6.0+ "));
                    } else {
                        OLED.setCursor(11, 5);
                        OLED.print(F(" Open MATRIXblock "));
                        OLED.setCursor(6, 18);
                        OLED.print(F("File->FirmwareUpdate"));
                    }
                    OLED.display(); 
                    delay(1);
                }
                OLED.clearDisplay();
                OLED.display();
            }
        }
    }
 
    return true;
}
 
MatrixMiniR4 MiniR4;