diff --git a/Src/Accel.c b/Src/Accel.c index dbe680f..fa70dd3 100644 --- a/Src/Accel.c +++ b/Src/Accel.c @@ -46,11 +46,15 @@ bool Accel_WaitReady(tAccel *env, uint32_t timeout) { return len > 0.1f; } +void DataAccel_Vector(tAccelCoor *xyz); static _Noreturn void Accel_Thread(tAccel *env) { //todo нужно переделать под таймер и семафор for (;;) { if (AccelQma6100P_Read(&env->accel, &env->current)) { + + DataAccel_Vector(&env->accel.xyz); + osMessageQueuePut(env->dataQueue, &env->current, 0, 0); env->errorDataFlag = true; } else {