diff --git a/branches/sim/accero.c b/branches/sim/accero.c index 96ea6dc..dc52759 100644 --- a/branches/sim/accero.c +++ b/branches/sim/accero.c @@ -79,9 +79,10 @@ task_status tsk_soft_int( ); task_status_immed tski_cbk_accero( ) { // (疑似)isrから登録されます static u8 err_count; + u8 acc_dat_buff[6]; // 加速度センサデータレジスタへの反映 - if( iic_mcu_read( IIC_SLA_ACCEL, ( ACC_REG_X | 0x80 ), 6, &vreg_ctr[VREG_C_ACC_XL] ) + if( iic_mcu_read( IIC_SLA_ACCEL, ( ACC_REG_X | 0x80 ), 6, acc_dat_buff ) != ERR_SUCCESS ) { err_count ++; @@ -101,6 +102,8 @@ task_status_immed tski_cbk_accero( ) } else { + memcpy( &vreg_ctr[VREG_C_ACC_XL], acc_dat_buff, 6 ); + err_count = 0; // 正常時パス // // 加速度更新&割り込み