/***************************************************************************
 *   Copyright (C) 2020 by Federico Izzo IU2NUO, Niccolò Izzo IU2KIN and   *
 *                         Silvano Seva IU2KWO                             *
 *                                                                         *
 *   This program is free software; you can redistribute it and/or modify  *
 *   it under the terms of the GNU General Public License as published by  *
 *   the Free Software Foundation; either version 3 of the License, or     *
 *   (at your option) any later version.                                   *
 *                                                                         *
 *   This program is distributed in the hope that it will be useful,       *
 *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
 *   GNU General Public License for more details.                          *
 *                                                                         *
 *   You should have received a copy of the GNU General Public License     *
 *   along with this program; if not, see <http://www.gnu.org/licenses/>   *
 ***************************************************************************/

#include <stdio.h>
#include <app_cfg.h>
#include <os.h>
#include <lib_mem.h>
#include <hwconfig.h>
#include <platform.h>

/*
 * Entry point for application code, not in this translation unit.
 */
int main(int argc, char *argv[]);

/*
 * OS startup task, will call main() when all initialisations are done.
 */
static OS_TCB        startTCB;
static CPU_STK_SIZE  startStk[APP_CFG_TASK_START_STK_SIZE];
static void startTask(void *arg);

void systemBootstrap()
{
    OS_ERR err;

    OSInit(&err);

    OSTaskCreate((OS_TCB     *)&startTCB,
                 (CPU_CHAR   *)" ",
                 (OS_TASK_PTR ) startTask,
                 (void       *) 0,
                 (OS_PRIO     ) APP_CFG_TASK_START_PRIO,
                 (CPU_STK    *)&startStk[0],
                 (CPU_STK     )startStk[APP_CFG_TASK_START_STK_SIZE / 10u],
                 (CPU_STK_SIZE) APP_CFG_TASK_START_STK_SIZE,
                 (OS_MSG_QTY  ) 0,
                 (OS_TICK     ) 0,
                 (void       *) 0,
                 (OS_OPT      )(OS_OPT_TASK_STK_CHK | OS_OPT_TASK_STK_CLR),
                 (OS_ERR     *)&err);

    OSStart(&err);

    for(;;) ;
}

static void startTask(void* arg)
{
    (void) arg;

    CPU_Init();

    /* SysTick is available only for ARM-based targets */
    #ifdef __arm__
    OS_CPU_SysTickInitFreq(SystemCoreClock);
    #else
    OS_CPU_SysTickInit();
    #endif

    /* Initialise platform drivers */
    platform_init();

    /* Jump to application code */
    main(0, NULL);

    /* If main returns loop indefinitely */
    for(;;) ;
}