Fix
This commit is contained in:
parent
3bf706c76e
commit
d5336ca8c5
|
|
@ -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 {
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue