Skip to content
main.cpp 1.03 KiB
Newer Older
Arnaud Cadot's avatar
Arnaud Cadot committed

#if defined(STM32F40_41xxx)
    #include "initKrabiJunior.h"

    #include "KJ2016Tempo.h"
#elif defined(STM32F10X_CL)
    #include "initkrabi.h"
#endif
hilnius's avatar
hilnius committed
#define NVIC_CCR ((volatile unsigned long *)(0xE000ED14))

int main()
{
    #if defined(STM32F10X_MD) || defined(STM32F10X_CL)
        *NVIC_CCR = *NVIC_CCR | 0x200; // Set STKALIGN in NVIC
    #else
        SystemInit(); // Appelée implicitement ?
    #endif
hilnius's avatar
hilnius committed

    #if defined(STM32F40_41xxx) // H405
        InitKrabiJunior initKJ;
Arnaud Cadot's avatar
Arnaud Cadot committed
        //initKJ.init(); // Not this year - we are NOT using odometry, strategiev2, etc, so it's best not to init them at all
        initKJ.initClock();
        initKJ.initGPIO();
        initKJ.initActionneurs(); // For servos
    #elif defined(STM32F10X_CL) // H107
        InitKrabi initKrabi;
        initKrabi.init();
    #endif
Maxime JEAN's avatar
Maxime JEAN committed

    Remote::getSingleton()->waitForConnection();
Arnaud Cadot's avatar
Arnaud Cadot committed
    /** Action sequencing for KJ **/
    #ifdef STM32F40_41xxx
        KJ2016Tempo::run(initKJ.isYellow());
    #endif

hilnius's avatar
hilnius committed
    while(1);

    return 0;
}