boolean HVAC_WaitParameters(int_32 timeout)
{
boolean catched;
#if DEMOCFG_ENABLE_SWITCH_TASK
// switch-sensing task is running, we can simply wait for the event or timeout
_lwevent_wait_ticks(&HVAC_Params.Event, HVAC_PARAMS_CHANGED, TRUE, timeout);
#else
// poll the keys frequenly until the event or timeout expires
uint_32 poll_wait = BSP_ALARM_FREQUENCY/20; // 50ms
int_32 elapsed;
MQX_TICK_STRUCT tickstart, ticknow;
_time_get_elapsed_ticks(&tickstart);
do
{
Switch_Poll();
_lwevent_wait_ticks(&HVAC_Params.Event, HVAC_PARAMS_CHANGED, TRUE, poll_wait);
_time_get_elapsed_ticks(&ticknow);
elapsed = _time_diff_ticks_int32 (&ticknow, &tickstart, NULL);
} while (elapsed < timeout);
#endif
catched = (HVAC_Params.Event.VALUE & HVAC_PARAMS_CHANGED) != 0;
_lwevent_clear(&HVAC_Params.Event, HVAC_PARAMS_CHANGED);
return catched;
}
void Init_Task(uint32_t task_init_data)
{
int tester=0;
//uint_8 sys=0;
bool bInitOpen=FALSE;
bool bInitStill=FALSE;
bool bInitVLPS=FALSE;
MQX_TICK_STRUCT ttt;
_mqx_uint mqx_ret;
trace_init();
show_version_information();
//////////////zga add
//Set LPTMR to timeout about 5 seconds
Lptmr_Init(1000, LPOCLK);
ADC_Init();
Calibrate_ADC();
ADC_Init();
DMA1_Init();
//////////////zga add
// clear flag
APP_TRACE("start 1\n\r");
_task_create_at(0, SHELL_TASK, 0, shell_task_stack, SHELL_TASK_STACK_SIZE);
_task_create_at(0, MMA8415_TASK, 0, mma8451_task_stack, MMA8451_TASK_STACK_SIZE);
Lptmr_Start();
for(;;)
{
mqx_ret = _lwsem_wait(&g_lptmr_int_sem);
// _time_delay_ticks(10);
tester++;
//_time_delay_ticks(10);
//APP_TRACE("tester is: %d\r\n",tester);
_time_get_elapsed_ticks(&ttt);
APP_TRACE("high ttt %d, low ttt%d\r\n", ttt.TICKS[1],ttt.TICKS[0]);
if(Measured)
{ Measured=0;
APP_TRACE ("light: %d ,%d \r\n", (uint16_t) MeasuredValues[1],tester);
}
if((GetTouchON()==TRUE))
{
SetSysStatus(ACTIVE_OPEN);
}
// for test
SetSysStatus(ACTIVE_OPEN);
switch (sysStatus)
{
case ACTIVE_OPEN:
bInitStill=FALSE;
bInitVLPS=FALSE;
APP_TRACE ("ACTIVE_OPEN\r\n");
if(bInitOpen==FALSE)
{
bInitOpen=TRUE;
putmma8451running();
SysTick_PDD_EnableDevice(SysTick_BASE_PTR, PDD_ENABLE);
}
break;
case ACTIVE_STILL:
bInitOpen=FALSE;
bInitVLPS=FALSE;
APP_TRACE ("ACTIVE_still\r\n");
if(bInitStill==FALSE)
{
bInitStill=TRUE;
putmma8451detect();
}
enter_vlps();
case VLPSMODE:
bInitOpen=FALSE;
bInitStill=FALSE;
APP_TRACE ("vlpsmode\r\n");
if(bInitVLPS==FALSE)
{
bInitVLPS=TRUE;
putmma8451standby();
}
enter_vlps();
default:
break;
}
}
}
/*!
* \brief MQX API handler for usermode - part of wrapper around standard MQX API
* which require privilege mode.
*
* \param[in] api_no API number - number of wrapped function
* \param[in] params generic parameter - direct use with called MQX API fn
*
* \return uint32_t return of called function
*/
uint32_t _mqx_api_call_handler
(
// [IN] API number - number of wrapped function
MQX_API_NUMBER_ENUM api_no,
// [IN] generic parameter - direct use with called MQX API fn
MQX_API_CALL_PARAMS_PTR params
)
{
int32_t res = -1;
uint32_t param0 = params->param0;
uint32_t param1 = params->param1;
uint32_t param2 = params->param2;
uint32_t param3 = params->param3;
uint32_t param4 = params->param4;
switch (api_no) {
// _lwsem
case MQX_API_LWSEM_POLL:
if (MQX_OK == (res = _lwsem_usr_check((LWSEM_STRUCT_PTR)param0)))
res = (uint32_t)_lwsem_poll((LWSEM_STRUCT_PTR)param0);
break;
case MQX_API_LWSEM_POST:
if (MQX_OK == (res = _lwsem_usr_check((LWSEM_STRUCT_PTR)param0)))
res = _lwsem_post((LWSEM_STRUCT_PTR)param0);
break;
case MQX_API_LWSEM_WAIT:
if (MQX_OK == (res = _lwsem_usr_check((LWSEM_STRUCT_PTR)param0)))
res = _lwsem_wait((LWSEM_STRUCT_PTR)param0);
break;
case MQX_API_LWSEM_CREATE:
res = _lwsem_create_internal((LWSEM_STRUCT_PTR)param0, (_mqx_int)param1, (bool)param2, TRUE);
break;
#if MQX_HAS_TICK
case MQX_API_LWSEM_WAIT_FOR:
if (MQX_OK == (res = _lwsem_usr_check((LWSEM_STRUCT_PTR)param0)) && (!param1 || _psp_mem_check_access(param1, sizeof(MQX_TICK_STRUCT), MPU_UM_RW)))
res = _lwsem_wait_for((LWSEM_STRUCT_PTR)param0, (MQX_TICK_STRUCT_PTR)param1);
break;
case MQX_API_LWSEM_WAIT_TICKS:
if (MQX_OK == (res = _lwsem_usr_check((LWSEM_STRUCT_PTR)param0)))
res = _lwsem_wait_ticks((LWSEM_STRUCT_PTR)param0, (_mqx_uint)param1);
break;
case MQX_API_LWSEM_WAIT_UNTIL:
if (MQX_OK == (res = _lwsem_usr_check((LWSEM_STRUCT_PTR)param0)) && (!param1 || _psp_mem_check_access(param1, sizeof(MQX_TICK_STRUCT), MPU_UM_RW)))
res = _lwsem_wait_until((LWSEM_STRUCT_PTR)param0, (MQX_TICK_STRUCT_PTR)param1);
break;
case MQX_API_LWSEM_DESTROY:
if (MQX_OK == (res = _lwsem_usr_check((LWSEM_STRUCT_PTR)param0))) {
res = _lwsem_destroy_internal((LWSEM_STRUCT_PTR)param0, TRUE);
}
break;
#endif // MQX_HAS_TICK
// _lwevent
#if MQX_USE_LWEVENTS
case MQX_API_LWEVENT_CLEAR:
if (MQX_OK == (res = _lwevent_usr_check((LWEVENT_STRUCT_PTR)param0)))
res = _lwevent_clear((LWEVENT_STRUCT_PTR)param0, (_mqx_uint)param1);
break;
case MQX_API_LWEVENT_SET:
if (MQX_OK == (res = _lwevent_usr_check((LWEVENT_STRUCT_PTR)param0)))
res = _lwevent_set((LWEVENT_STRUCT_PTR)param0, (_mqx_uint)param1);
break;
case MQX_API_LWEVENT_SET_AUTO_CLEAR:
if (MQX_OK == (res = _lwevent_usr_check((LWEVENT_STRUCT_PTR)param0)))
res = _lwevent_set_auto_clear((LWEVENT_STRUCT_PTR)param0, (_mqx_uint)param1);
break;
case MQX_API_LWEVENT_WAIT_FOR:
if (MQX_OK == (res = _lwevent_usr_check((LWEVENT_STRUCT_PTR)param0)) && \
(!param3 || _psp_mem_check_access(param3, sizeof(MQX_TICK_STRUCT), MPU_UM_RW))) {
res = _lwevent_wait_for((LWEVENT_STRUCT_PTR)param0, (_mqx_uint)param1, (bool)param2, (MQX_TICK_STRUCT_PTR)param3);
}
break;
case MQX_API_LWEVENT_WAIT_FOR_TICKS:
if (MQX_OK == (res = _lwevent_usr_check((LWEVENT_STRUCT_PTR)param0))) {
res = _lwevent_wait_ticks((LWEVENT_STRUCT_PTR)param0, (_mqx_uint)param1, (bool)param2, (_mqx_uint)param3);
}
break;
case MQX_API_LWEVENT_WAIT_UNTIL:
if (MQX_OK == (res = _lwevent_usr_check((LWEVENT_STRUCT_PTR)param0)) && \
(!param3 || _psp_mem_check_access(param3, sizeof(MQX_TICK_STRUCT), MPU_UM_RW))) {
res = _lwevent_wait_until((LWEVENT_STRUCT_PTR)param0, (_mqx_uint)param1, (bool)param2, (MQX_TICK_STRUCT_PTR)param3);
}
break;
case MQX_API_LWEVENT_GET_SIGNALLED:
res = _lwevent_get_signalled();
break;
case MQX_API_LWEVENT_CREATE:
res = _lwevent_create_internal((LWEVENT_STRUCT_PTR)param0, (_mqx_uint)param1, TRUE);
break;
case MQX_API_LWEVENT_DESTROY:
if (MQX_OK == (res = _lwevent_usr_check((LWEVENT_STRUCT_PTR)param0))) {
res = _lwevent_destroy_internal((LWEVENT_STRUCT_PTR)param0, TRUE);
}
break;
#endif
#if MQX_USE_LWMSGQ
case MQX_API_LWMSGQ_INIT:
res = _lwmsgq_init_internal((void *)param0, (_mqx_uint)param1, (_mqx_uint)param2, TRUE);
break;
case MQX_API_LWMSGQ_RECEIVE:
if (MQX_OK == (res = _lwmsgq_usr_check((LWMSGQ_STRUCT_PTR)param0)) && \
_psp_mem_check_access(param1, ((LWMSGQ_STRUCT_PTR)param0)->MSG_SIZE, MPU_UM_RW) && \
(!param4 || _psp_mem_check_access(param4, sizeof(MQX_TICK_STRUCT), MPU_UM_RW)))
res = _lwmsgq_receive((void *)param0, (_mqx_max_type_ptr)param1, (_mqx_uint)param2, (_mqx_uint)param3, (MQX_TICK_STRUCT_PTR)param4);
break;
case MQX_API_LWMSGQ_SEND:
if (MQX_OK == (res = _lwmsgq_usr_check((LWMSGQ_STRUCT_PTR)param0)) && \
_psp_mem_check_access(param1, ((LWMSGQ_STRUCT_PTR)param0)->MSG_SIZE, MPU_UM_RW))
res = _lwmsgq_send((void *)param0, (_mqx_max_type_ptr)param1, (_mqx_uint)param2);
break;
#endif // MQX_USE_LWMSGQ
case MQX_API_TASK_CREATE:
res = _task_create_internal((_processor_number)param0, (_mqx_uint)param1, (uint32_t)param2, TRUE);
break;
case MQX_API_TASK_DESTROY:
res = _task_destroy_internal((_task_id)param0, TRUE);
break;
case MQX_API_TASK_ABORT:
res = _task_abort_internal((_task_id)param0, TRUE);
break;
case MQX_API_TASK_READY:
_task_ready((void *)param0);
res = MQX_OK; // irelevant, function is without return value
break;
case MQX_API_TASK_SET_ERROR:
res = _task_set_error((_mqx_uint)param0);
break;
case MQX_API_TASK_GET_TD:
res = (uint32_t)_task_get_td((_task_id)param0);
break;
#if MQX_USE_LWMEM
case MQX_API_LWMEM_ALLOC:
res = (uint32_t)_usr_lwmem_alloc_internal((_mem_size)param0);
break;
case MQX_API_LWMEM_ALLOC_FROM:
if (_psp_mem_check_access(param0, sizeof(LWMEM_POOL_STRUCT), MPU_UM_RW) && \
_psp_mem_check_access((uint32_t)(((LWMEM_POOL_STRUCT_PTR)param0)->POOL_ALLOC_START_PTR), (char*)(((LWMEM_POOL_STRUCT_PTR)param0)->POOL_ALLOC_END_PTR) - (char*)(((LWMEM_POOL_STRUCT_PTR)param0)->POOL_ALLOC_START_PTR), MPU_UM_RW))
res = (uint32_t)_lwmem_alloc_from((_lwmem_pool_id)param0, (_mem_size)param1);
else
res = 0; // NULL, allocation failed
break;
case MQX_API_LWMEM_FREE:
if (_psp_mem_check_access(param0, 4, MPU_UM_RW))
res = _lwmem_free((void *)param0);
break;
case MQX_API_LWMEM_CREATE_POOL:\
if (_psp_mem_check_access(param0, sizeof(LWMEM_POOL_STRUCT), MPU_UM_RW) && \
_psp_mem_check_access(param1, param2, MPU_UM_RW))
res = (uint32_t)_lwmem_create_pool((LWMEM_POOL_STRUCT_PTR)param0, (void *)param1, (_mem_size)param2);
break;
case MQX_API_LWMEM_REALLOC:
if (_psp_mem_check_access(param0, 4, MPU_UM_RW))
res = (uint32_t)_lwmem_realloc((void *)param0,(_mem_size)param1);
break;
#endif // MQX_USE_LWMEM
// _time
case MQX_API_TIME_DELAY:
_time_delay(param0);
res = MQX_OK; // irelevant, function is without return value
break;
#if MQX_HAS_TICK
case MQX_API_TIME_DELAY_TICKS:
_time_delay_ticks(param0);
res = MQX_OK; // irelevant, function is without return value
break;
case MQX_API_TIME_GET_ELAPSED_TICKS:
if (_psp_mem_check_access(param0, sizeof(MQX_TICK_STRUCT), MPU_UM_RW)) {
_time_get_elapsed_ticks((MQX_TICK_STRUCT_PTR)param0);
res = MQX_OK; // irelevant, function is without return value
}
else {
_task_set_error(MQX_ACCESS_ERROR);
}
break;
#endif // MQX_HAS_TICK
default:
while (1);
}
return res;
}
static void mma8451_getdata(void)
{
byte Data;
LDD_TError ret;
byte Color[192];
signed short accel_x, accel_y, accel_z=0;
int i,j=0;
uint_8 sign_bit=0;
uint_8 angle=0;
MQX_TICK_STRUCT ttt;
// Determine source of interrupt by reading the system interrupt
ret = ReadAccRegs(g_I2C_DeviceData,
&g_DataState,
INT_SOURCE_REG,
ACC_REG_SIZE,
&Data);
if (ret)
{
APP_TRACE("interrupt source: 0x%X\r\n", Data);
// Set up Case statement here to service all of the possible interrupts
if ((Data &0x04) == 0x04) //detection interrupt
{
APP_TRACE("get detect interrupt\r\n");
//Perform an Action since Motion Flag has been set
//Read the Motion/Freefall Function to clear the interrupt
ret = ReadAccRegs(g_I2C_DeviceData,
&g_DataState,
FF_MT_SRC_REG,
ACC_REG_SIZE,
&Data);
enablemma8451running();
}
if ((Data &SRC_FIFO_MASK) == 0x40) // FIFO Data interrupt
{
ret = ReadAccRegs(g_I2C_DeviceData, &g_DataState, OUT_X_MSB, 192 * ACC_REG_SIZE, Color); // Read x,y,z acceleration data.
for(i=0;i<32;i++)
{
j=6*i;
accel_x = Color[j+1] | (Color[j+0]<<8);
accel_x >>= 2;
accel_y = Color[j+3] | (Color[j+2]<<8);
accel_y >>= 2;
accel_z = Color[j+5] | (Color[j+4]<<8);
accel_z >>= 2;
if(accel_z>=0)
sign_bit=1;
else
sign_bit=0;
angle=angle_calculation(accel_z,sign_bit);
//put status in still mode or not?
if(angle<15&&(abs(angle-z_angle_tmp))<1)
{
SetAccStatus(ACC_STILL);
}
z_angle_tmp=angle;
///////////end sti
Angle_1s[buffer_count]=angle;
buffer_count++;
if(buffer_count==buffer_size)
{
buffer_count=0;
_time_get_elapsed_ticks(&ttt);
// APP_TRACE("high tick %d, low first st%d\r\n", ttt.TICKS[1],ttt.TICKS[0]);
FindFirstPeak();
_time_get_elapsed_ticks(&ttt);
// APP_TRACE("high tick %d, low last end%d\r\n", ttt.TICKS[1],ttt.TICKS[0]);
FindLastPeak();
_time_get_elapsed_ticks(&ttt);
// APP_TRACE("high tick %d, low last end%d\r\n", ttt.TICKS[1],ttt.TICKS[0]);
}
// APP_TRACE("tilt %d,y=%05d,z=%05d\r\n", angle, accel_y, accel_z);
}
}
}
