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);
 
    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);
        }
    }
    
    //Check the FW version is outdated or not.
    String FWVersion_S;
    MMLower::RESULT resultFWCheck = mmL.GetFWVersion(FWVersion_S);
    if (result == 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 < 3 || (FWmajorVersion == 3 && FWminorVersion < 40)) {
                OLED.setTextSize(1);
                OLED.setCursor(11, 5);
                OLED.print(F("Firmware Outdated!"));
                OLED.setCursor(11, 18);
                OLED.print(F("-Press UP to Skip-"));
                OLED.display();
                for (uint8_t i = 0; i < 3; i++) {
                    Buzzer.Tone(500, 100);
                    delay(100);
                    Buzzer.NoTone();
                    delay(100);
                }
                while (BTN_UP.getState() == false) {
                    delay(1);
                }
                OLED.clearDisplay();
                OLED.display();
            }
        }
    }
    
    return true;
}
 
MatrixMiniR4 MiniR4;