Subversion Repositories NaviCtrl

#include "91x_lib.h"
#include "params.h"
#include "spi_slave.h"
#include "waypoints.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;

        switch(id)
        {
                case NCPARAMS_NEW_COMPASS_DIRECTION_SETPOINT:
                    if(NULL == WPList_GetPOI())
                        {
                                CAM_Orientation.Azimuth = *pvalue;
                                CAM_Orientation.Elevation = 0;
                                CAM_Orientation.State = NEWDATA;
                        }
                        break;

                default:
                        break;
        }
        return 1;      
}

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