Subversion Repositories NaviCtrl

#include "91x_lib.h"
#include "params.h"
#include "spi_slave.h"

s16 NCParams[255];

void NCParams_Init(void)
{
        NCParams[NCPARAMS_GPS_TARGETSPEED] = 50; // 5.0 m/s
        NCParams[NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT] = -1;
}

u8 NCParams_SetValue(u8 id, s16* pvalue)
{
        NCParams[id] = *pvalue;
// Process data
    if(id == NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT) NewCompassDirectionSetpoint = NCParams[NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT];
        return 1;      
}

u8 NCParams_GetValue(u8 id, s16* pvalue)
{
        if(pvalue == 0) return 0;
        *pvalue = NCParams[id];
        return 1;
}