PUBLIC bool_t bShakereadResult( int16* ai16accel )
{
static int16 ai16TmpAccel[3]={0, 0, 0};
bool_t bOk = TRUE;
uint8 au8data[2];
int16 max = 0x8000;
uint8 num; // FIFOのデータ数
uint8 i;
int16 sum[32];
uint8 count = 0;
int16 x[33];
int16 y[33];
int16 z[33];
// FIFOでたまった個数を読み込む
bOk &= bSMBusWrite(ADXL345_ADDRESS, ADXL345_FIFO_STATUS, 0, NULL );
bOk &= bSMBusSequentialRead( ADXL345_ADDRESS, 1, &num );
// FIFOの中身を全部読む
num = (num&0x7f);
if( num == READ_FIFO ){
// 各軸の読み込み
for( i=0; i<num; i++ ){
// X軸
bOk &= bGetAxis( ADXL345_IDX_X, au8data );
x[i] = (((au8data[1] << 8) | au8data[0]));
}
for( i=0; i<num; i++ ){
// Y軸
bOk &= bGetAxis( ADXL345_IDX_Y, au8data );
y[i] = (((au8data[1] << 8) | au8data[0]));
}
for( i=0; i<num; i++ ){
// Z軸
bOk &= bGetAxis( ADXL345_IDX_Z, au8data );
z[i] = (((au8data[1] << 8) | au8data[0]));
}
// FIFOの設定をもう一度
bOk &= bSetFIFO();
for( i=0; i<num; i++ ){
x[i] = (x[i]<<2)/10;
y[i] = (y[i]<<2)/10;
z[i] = (z[i]<<2)/10;
if( i == 0 ){
sum[i] = ( x[i]-ai16TmpAccel[0] + y[i]-ai16TmpAccel[1] + z[i]-ai16TmpAccel[2] );
}else{
sum[i] = ( x[i]-x[i-1] + y[i]-y[i-1] + z[i]-z[i-1] );
}
if( sum[i] < 0 ){
sum[i] *= -1;
}
max = sum[i]>max ? sum[i] : max;
if( sum[i] > u16ThAccel ){
count++;
}
#if 0
vfPrintf(& sSerStream, "\n\r%2d:%d,%d,%d %d", i, x[i], y[i], z[i], sum[i] );
SERIAL_vFlush(E_AHI_UART_0);
}
vfPrintf( &sSerStream, "\n\r" );
#else
}
#endif
ai16accel[0] = max;
ai16accel[1] = z[0];
ai16accel[2] = count;
ai16TmpAccel[0] = x[num-1];
ai16TmpAccel[1] = y[num-1];
ai16TmpAccel[2] = z[num-1];
}else{
static void vProcessEvCore(tsEvent *pEv, teEvent eEvent, uint32 u32evarg) {
switch (pEv->eState) {
/*
* 起動時の状態
* ToCoNetの接続を行う。
* - スリープ復帰時は直前のアドレスに対して復帰をかける。失敗した場合は再探索を行う。
*/
case E_STATE_IDLE:
// start up message
V_PRINTF(LB "*** ToCoSamp IO Monitor %d.%02d-%d %s ***", VERSION_MAIN, VERSION_SUB, VERSION_VAR, sAppData.bWakeupByButton ? "BTN" : "OTR");
V_PRINTF(LB "* App ID:%08x Long Addr:%08x Short Addr %04x",
sToCoNet_AppContext.u32AppId, ToCoNet_u32GetSerial(), sToCoNet_AppContext.u16ShortAddress);
SERIAL_vFlush(UART_PORT);
if (eEvent == E_EVENT_START_UP) {
if (IS_APPCONF_OPT_SECURE()) {
bool_t bRes = bRegAesKey(sAppData.sFlash.sData.u32EncKey);
V_PRINTF(LB "*** Register AES key (%d) ***", bRes);
}
#ifdef USE_LCD
vLcdInit(); // register sLcd
// 最下行を表示する
V_PRINTF_LCD_BTM("*** ToCoSamp IO Monitor %d.%02d-%d ***", VERSION_MAIN, VERSION_SUB, VERSION_VAR);
vLcdRefresh();
#endif
}
if (eEvent == E_EVENT_START_UP && (u32evarg & EVARG_START_UP_WAKEUP_RAMHOLD_MASK)) {
V_PRINTF(LB "* Warm starting woke by %s.", sAppData.bWakeupByButton ? "DIO" : "WakeTimer");
/*
* 接続復帰（スリープ後）
*/
sAppData.eLedState = E_LED_WAIT;
ToCoNet_Nwk_bResume(sAppData.pContextNwk); // ネットワークの復元
ToCoNet_Event_SetState(pEv, E_STATE_APP_WAIT_NW_START);
} else
if (eEvent == E_EVENT_START_UP) {
V_PRINTF(LB "* start end device[%d]", u32TickCount_ms & 0xFFFF);
/*
* ネットワークの接続
*/
sAppData.sNwkLayerTreeConfig.u8Role = TOCONET_NWK_ROLE_ENDDEVICE; // EndDevice として構成する
sAppData.sNwkLayerTreeConfig.u8ScanDur_10ms = 4; // 探索時間(中継機の数が数個程度なら 40ms 程度で十分)
sAppData.pContextNwk = ToCoNet_NwkLyTr_psConfig(&sAppData.sNwkLayerTreeConfig); // 設定
if (sAppData.pContextNwk) {
ToCoNet_Nwk_bInit(sAppData.pContextNwk); // ネットワーク初期化
ToCoNet_Nwk_bStart(sAppData.pContextNwk); // ネットワーク開始
}
sAppData.eLedState = E_LED_WAIT;
ToCoNet_Event_SetState(pEv, E_STATE_APP_WAIT_NW_START);
break;
}
break;
/*
* ネットワークの開始待ち
*/
case E_STATE_APP_WAIT_NW_START:
if (eEvent == E_EVENT_TOCONET_NWK_START) {
ToCoNet_Event_SetState(pEv, E_STATE_RUNNING);
}
if (ToCoNet_Event_u32TickFrNewState(pEv) > 500) {
ToCoNet_Event_SetState(pEv, E_STATE_APP_SLEEP);
}
break;
/*
* 実行時の状態
* - ネットワーク開始後、メッセージプール要求を行う
* - ネットワークがエラーになったり、タイムアウトが発生した場合はエラー状態とし、
* 再びスリープする
*/
case E_STATE_RUNNING:
if (eEvent == E_EVENT_NEW_STATE) {
// ネットワーク開始
V_PRINTF(LB"[NWK STARTED and REQUEST IO STATE:%d]", u32TickCount_ms & 0xFFFF);
static uint8 u8Ct;
#ifdef MSGPL_SLOT_TEST
// メッセージプールの複数スロットのテストを行う
// 起動ごとにスロット番号を変更して取得する
u8Ct++;
#else
u8Ct = 0;
#endif
// メッセージプールの要求
if (ToCoNet_MsgPl_bRequest(u8Ct % TOCONET_MOD_MESSAGE_POOL_MAX_ENTITY)) {
ToCoNet_Event_SetState(pEv, E_STATE_APP_IO_WAIT_RX);
} else {
ToCoNet_Event_SetState(pEv, E_STATE_APP_IO_RECV_ERROR);
}
} else
if (eEvent == E_EVENT_TOCONET_NWK_DISCONNECT) {
ToCoNet_Event_SetState(pEv, E_STATE_APP_IO_RECV_ERROR);
} else {
if (ToCoNet_Event_u32TickFrNewState(pEv) > ENDD_TIMEOUT_CONNECT_ms) {
ToCoNet_Event_SetState(pEv, E_STATE_APP_IO_RECV_ERROR);
}
}
break;
/*
* メッセージプールからの伝達待ち。
* - メッセージプールは cbToCoNet_vNwkEvent() に通知され、
* その関数中でE_EVENT_APP_GET_IC_INFOイベントを発行する。
*/
case E_STATE_APP_IO_WAIT_RX:
if (eEvent == E_EVENT_NEW_STATE) {
V_PRINTF(LB"[E_STATE_APP_IO_WAIT_RX:%d]", u32TickCount_ms & 0xFFFF);
} if (eEvent == E_EVENT_APP_GET_IC_INFO) {
// メッセージが届いた
if (u32evarg) {
V_PRINTF(LB"[E_STATE_APP_IO_WAIT_RX:GOTDATA:%d]", u32TickCount_ms & 0xFFFF);
ToCoNet_Event_SetState(pEv, E_STATE_APP_SLEEP);
} else {
ToCoNet_Event_SetState(pEv, E_STATE_APP_IO_RECV_ERROR);
}
} else {
// タイムアウト
if (ToCoNet_Event_u32TickFrNewState(pEv) > ENDD_TIMEOUT_WAIT_MSG_ms) {
V_PRINTF(LB"[E_STATE_APP_IO_WAIT_RX:TIMEOUT:%d]", u32TickCount_ms & 0xFFFF);
ToCoNet_Event_SetState(pEv, E_STATE_APP_IO_RECV_ERROR);
}
}
break;
/*
* 送信完了の処理
* - スリープ実行
*/
case E_STATE_APP_IO_RECV_ERROR:
case E_STATE_APP_SLEEP:
if (eEvent == E_EVENT_NEW_STATE) {
if (pEv->eState == E_STATE_APP_SLEEP) {
V_PRINTF(LB"[E_STATE_APP_SLEEP_LED:%d]", u32TickCount_ms & 0xFFFF);
sAppData.eLedState = E_LED_RESULT;
} else {
V_PRINTF(LB"[E_STATE_APP_IO_RECV_ERROR:%d]", u32TickCount_ms & 0xFFFF);
sAppData.eLedState = E_LED_ERROR;
}
vPortSetHi(PORT_KIT_LED1);
vPortSetHi(PORT_KIT_LED2);
#ifdef NO_SLEEP
ToCoNet_Event_SetState(pEv, E_STATE_APP_PREUDO_SLEEP);
#else
ToCoNet_Nwk_bPause(sAppData.pContextNwk);
SERIAL_vFlush(UART_PORT);
vSleep(0, FALSE, FALSE);
#endif
}
break;
case E_STATE_APP_PREUDO_SLEEP:
// 指定時間スリープ相当の時間待ちを行う
if (ToCoNet_Event_u32TickFrNewState(pEv) > ENDD_SLEEP_PERIOD_s * 1000UL) {
ToCoNet_Event_SetState(pEv, E_STATE_RUNNING);
}
break;
default:
break;
}
}
