void FalconBoard::qParamSensoresInerciales(QByteArray paquete)
{
    qPacketParamSensoresInerciales_t *qinerciales;
    qinerciales = (qPacketParamSensoresInerciales_t *)(paquete.data() + 4);
    qinerciales->gx *= 180.0 / pi;
    emit gyroUpdate(qinerciales->gx, qinerciales->gy, qinerciales->gz);
    emit accUpdate(qinerciales->accx,qinerciales->accy, qinerciales->accz);
    emit magUpdate(qinerciales->magx, qinerciales->magy, qinerciales->magz);
    //qDebug() << qinerciales->gx << "," <<  qinerciales->gy << "," <<  qinerciales->gz;
}
Example #2
0
static void taskUpdateAccelerometer(timeUs_t currentTimeUs)
{
    UNUSED(currentTimeUs);

    accUpdate(&accelerometerConfigMutable()->accelerometerTrims);
}