bool_t GetData_AM2320(AM2320Data *data) {
uint8 Cmd[2];
uint8 Read[8];
bool_t bOk = TRUE;
int x;
ZeroMemory(Cmd, sizeof(Cmd));
ZeroMemory(Read, sizeof(Read));
bOk &= bSMBusWrite(AM2320_ADDR, 0, 0, NULL);
for (x = 0; x < 1600; x++) {;}
if (bOk == FALSE) return FALSE;
Cmd[0] = 0x00;
Cmd[1] = 0x04;
bOk = bSMBusWrite(AM2320_ADDR, 0x03, 2, Cmd);
for (x = 0; x < 1600; x++) {;}
if (bOk == FALSE) return FALSE;
for (x = 0; x <= 5; x++) {
bOk = bSMBusSequentialRead(AM2320_ADDR, 8, Read);
if (bOk == TRUE) break;
}
if (bOk == FALSE) return FALSE;
uint16 crc, calc_crc;
crc = (Read[7] << 8) | Read[6];
calc_crc = CRC16Calc(Read, 6);
if (crc != calc_crc) return FALSE;
data->Humidity = (Read[2] << 8) | Read[3];
data->Temp = (Read[4] << 8) | Read[5];
return TRUE;
}
PUBLIC bool_t bNekotterreadResult( int16* ai16accel )
{
bool_t bOk = TRUE;
int16 ai16result[3];
uint8 au8data[2];
int8 num;
uint8 data;
uint8 i, j;
int16 ave;
int16 sum[3] = { 0, 0, 0 }; // サンプルの総和
uint32 ssum[3] = { 0, 0, 0 }; // サンプルの2乗和
// FIFOでたまった個数を読み込む
bOk &= bSMBusWrite(ADXL345_ADDRESS, ADXL345_FIFO_STATUS, 0, NULL );
bOk &= bSMBusSequentialRead( ADXL345_ADDRESS, 1, &data );
num = (int8)(data&0x7f);
for( i=0; i<num; i++ ){
// 各軸の読み込み
// X軸
bOk &= bGetAxis( ADXL345_IDX_X, au8data );
ai16result[ADXL345_IDX_X] = (((au8data[1] << 8) | au8data[0]));
// Y軸
bOk &= bGetAxis( ADXL345_IDX_Y, au8data );
ai16result[ADXL345_IDX_Y] = (((au8data[1] << 8) | au8data[0]));
// Z軸
bOk &= bGetAxis( ADXL345_IDX_Z, au8data );
ai16result[ADXL345_IDX_Z] = (((au8data[1] << 8) | au8data[0]));
// 総和と二乗和の計算
for( j=0; j<3; j++ ){
sum[j] += ai16result[j];
ssum[j] += ai16result[j]*ai16result[j];
}
//vfPrintf(& sSerStream, "\n\r%2d:%d,%d,%d", i, ai16result[ADXL345_IDX_X], ai16result[ADXL345_IDX_Y], ai16result[ADXL345_IDX_Z]);
//SERIAL_vFlush(E_AHI_UART_0);
}
for( i=0; i<3; i++ ){
// 分散が評価値 分散の式を変形
ave = sum[i]/num;
ai16accel[i] = (int16)sqrt((double)(-1*(ave*ave)+(ssum[i]/num)));
}
// ねこったーモードはじめ
// FIFOの設定をもう一度
bOk &= bSetFIFO();
// 終わり
return bOk;
}
/****************************************************************************
*
* NAME: u16TSL2561readResult
*
* DESCRIPTION:
* Wrapper to read a measurement, followed by a conversion function to work
* out the value in degrees Celcius.
*
* RETURNS:
* int16: 0~10000 [1 := 5Lux], 100 means 500 Lux.
* 0x8000, error
*
* NOTES:
* the data conversion fomula is :
* ReadValue / 1.2 [LUX]
*
****************************************************************************/
PUBLIC uint32 u32TSL2561readResult( void )
{
bool_t bOk = TRUE;
uint32 u32result = 0x00;
uint16 data[2];
uint8 au8data[2];
uint8 command;
uint32 Lux;
command = CMD | WORD | TSL2561_DATA0;
bOk &= bSMBusWrite(TSL2561_ADDRESS, command, 0, NULL );
bOk &= bSMBusSequentialRead(TSL2561_ADDRESS, 2, au8data);
if (bOk == FALSE) {
u32result = (uint16)SENSOR_TAG_DATA_ERROR;
} else {
data[0] = ((au8data[1] << 8) | au8data[0]); // 読み込んだ数値を代入
command = CMD | WORD | TSL2561_DATA1;
bOk &= bSMBusWrite(TSL2561_ADDRESS, command, 0, NULL );
bOk &= bSMBusSequentialRead(TSL2561_ADDRESS, 2, au8data);
if (bOk == FALSE) {
u32result = SENSOR_TAG_DATA_ERROR;
}
data[1] = ((au8data[1] << 8) | au8data[0]); // 読み込んだ数値を代入
// TSL2561FN 照度の計算
Lux = u32CalcLux(data);
u32result = Lux;
}
#ifdef SERIAL_DEBUG
vfPrintf(&sDebugStream, "\n\rTSL2561 DATA %x", *((uint16*)au8data) );
#endif
return u32result;
}
/** @ingroup MASTER
* I2C のコマンドを実行して、応答を返します。
* 無線経由ので要求の場合は、応答は送信元へ無線パケットで戻されます。
* アドレスが0xDBの場合は、要求は自身のモジュールで実行された上 UART に応答します。
*
* - 入力フォーマット
* - OCTET: ネットワークアドレス(宛先,0xDBは自身のモジュールで実行してUARTに出力)
* - OCTET: 0x88
* - OCTET: 要求番号
* - OCTET: コマンド (0x1: Write, 0x2: Read, 0x3: Write and Increment, 0x4: Write and Read)
* - OCTET: I2Cアドレス
* - OCTET: I2Cコマンド
* - OCTET: データサイズ (無い時は 0)
* - OCTET[N]: データ (データサイズが0のときは、本フィールドは無し)
*
* - 出力フォーマット
* - OCTET: ネットワークアドレス
* - OCTET: 0x89
* - OCTET: 要求番号、入力フォーマットの値がコピーされる
* - OCTET: コマンド (0x1: Write, 0x2: Read)
* - OCTET: 0:FAIL, 1:SUCCESS
* - OCTET: データサイズ (無い時は 0)
* - OCTET[N]: データ (データサイズが0のときは、本フィールドは無し)
*
* @param p 入力書式のバイト列
* @param u16len バイト列長
* @param u8AddrSrc 要求元のネットワークアドレス
*/
void vProcessI2CCommand(uint8 *p, uint16 u16len, uint8 u8AddrSrc) {
//uint8 *p_end = p + u16len;
uint8 au8OutBuf[256 + 32];
uint8 *q = au8OutBuf;
bool_t bOk = TRUE;
uint8 n;
static volatile uint16 x;
// 入力データの解釈
uint8 u8Addr = G_OCTET();
(void) u8Addr;
uint8 u8Command = G_OCTET();
if (u8Command != SERCMD_ID_I2C_COMMAND) {
return;
}
uint8 u8ReqNum = G_OCTET();
uint8 u8I2C_Oper = G_OCTET();
uint8 u8I2C_Addr = G_OCTET();
uint8 u8I2C_Cmd = G_OCTET();
uint8 u8DataSize = G_OCTET();
uint8 *pu8data = p;
//uint8 *pu8data_end = p + u8DataSize;
#if 0
if (pu8data_end != p_end) {
DBGOUT(1, "I2CCMD: incorrect data."LB);
return;
}
#endif
// 出力用のバッファを用意しておく
S_OCTET(sAppData.u8AppLogicalId);
S_OCTET(SERCMD_ID_I2C_COMMAND_RESP);
S_OCTET(u8ReqNum);
S_OCTET(u8I2C_Oper);
//ここで q[0] 成功失敗フラグ, q[1] データサイズ, q[2]... データ
q[0] = FALSE;
q[1] = 0;
DBGOUT(1, "I2CCMD: req#=%d Oper=%d Addr=%02x Cmd=%02x Siz=%d"LB, u8ReqNum,
u8I2C_Oper, u8I2C_Addr, u8I2C_Cmd, u8DataSize);
switch (u8I2C_Oper) {
case 1:
bOk &= bSMBusWrite(u8I2C_Addr, u8I2C_Cmd, u8DataSize,
u8DataSize == 0 ? NULL : pu8data);
break;
case 2:
if (u8DataSize > 0) {
bOk &= bSMBusSequentialRead(u8I2C_Addr, u8DataSize, &(q[2]));
if (bOk)
q[1] = u8DataSize;
} else {
bOk = FALSE;
}
break;
case 3:
for (n = 0; n < u8DataSize; n++) {
bOk &= bSMBusWrite(u8I2C_Addr, u8I2C_Cmd + n, 1, &pu8data[n]);
for (x = 0; x < 16000; x++)
; //wait (e.g. for memory device)
}
break;
case 4:
if (u8DataSize > 0) {
bOk &= bSMBusWrite(u8I2C_Addr, u8I2C_Cmd, 0, NULL );
if (bOk)
bOk &= bSMBusSequentialRead(u8I2C_Addr, u8DataSize, &(q[2]));
if (bOk)
q[1] = u8DataSize;
} else {
bOk = FALSE;
}
break;
#ifdef USE_I2C_ACM1620
case 0x21: // ACM1620
bDraw2LinesLcd_ACM1602((const char *) pu8data,
(const char *) (pu8data + 16));
break;
#endif
#ifdef USE_I2C_AQM0802A
case 0x22: // ACM1620
bDraw2LinesLcd_AQM0802A((const char *) pu8data,
(const char *) (pu8data + 8));
break;
#endif
default:
DBGOUT(1, "I2CCMD: unknown operation(%d)."LB, u8I2C_Oper);
return;
}
q[0] = bOk; // 成功失敗フラグを書き込む
q = q + 2 + q[1]; // ポインタ q を進める（データ末尾+1)
if (u8AddrSrc == SERCMD_ADDR_TO_MODULE) {
SerCmdAscii_Output_AdrCmd(&sSerStream, u8AddrSrc, au8OutBuf[1],
au8OutBuf + 2, q - au8OutBuf - 2);
} else {
i16TransmitSerMsg(au8OutBuf, q - au8OutBuf, ToCoNet_u32GetSerial(),
sAppData.u8AppLogicalId, u8AddrSrc, FALSE,
sAppData.u8UartReqNum++);
}
}
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{