varch/test/test_oscp.c

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <math.h>
#include <sys/time.h>
#if defined(TEST_TARGET_oscp)
#include <varch/command.h>
#include <varch/oscp.h>
#include <varch/kern.h>
#else  
#include "init.h"
#include "command.h"
#include "oscp.h"
#include "kern.h"
#endif

int level = 0;

static unsigned int get_msec(void)
{
    struct timeval mstime;
    unsigned int ms = 0;
    gettimeofday(&mstime, NULL);
    ms = mstime.tv_sec * 1000 + mstime.tv_usec / 1000;
    return ms;
}

static void task1(void)
{
    oscp_handle();
}

static void task2(void)
{
    static int count = 0;
    
    count++;
    if (count > 628) count = 0;

    level = RESOLUTION / 2 * sin((double)count / 10) + RESOLUTION / 2;
}

static void usage(void)
{
    printf(
"Usage: oscp [opt] [arg]\n"
"\n"
"options:\n"
"    -h                  Print help\n"
"    -v                  Print version\n"
"\n"
"argument:\n"
"    <read>              Test default read function\n"
"    <write>             Test default write function\n"
    );
}

static int test(int argc, char *argv[])
{
    /* reset getopt */
    command_opt_init();

    while (1)
    {
        int opt = command_getopt(argc, argv, "hv");
        if (opt == -1) break;

        switch (opt) 
        {
        case 'v' :
            printf("oscp version %d.%d.%d\r\n", OSCP_V_MAJOR, OSCP_V_MINOR, OSCP_V_PATCH);
            return 0;
        case '?':
            printf("Unknown option `%c`\r\n", command_optopt);
            return -1;
        case 'h' : 
        default:
            usage();
            return 0;
        }
    }

    if (kern_init(get_msec, 1) == KE_OK)
    {
        printf("kern init success!\r\n");
    }
    else  
    {
        printf("*** kern init fail!\r\n");
        return 0;
    }

    printf("create task %d\r\n", task_create(5, task1));
    printf("create task %d\r\n", task_create(50, task2));
    
    oscp_set_scale(O_SCALE_50MS);
    oscp_set_monitor(&level);

    kern_schedule();
    
    return 0;
}

#if defined(TEST_TARGET_oscp)
int main(int argc, char *argv[])
{
    return test(argc, argv);
}
#else 
void test_oscp(void)
{
    command_export("oscp", test);
}
init_export_app(test_oscp);
#endif