This commit is contained in:
cfif 2024-12-09 13:40:18 +03:00
parent 3bf706c76e
commit d5336ca8c5
1 changed files with 4 additions and 0 deletions

View File

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