| /hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/driverexamples/demos/ |
| D | orientaion_application_baremetal_agm01.c | 108 Quaternion *fq,
228 …SV_ptr data, Quaternion *fq, int16_t *iPhi, int16_t *iThe, int16_t *iRho, int16_t iOmega[], uint16… in readAlgoParams() argument
230 *fq = data->fq; in readAlgoParams()
271 Quaternion fq; /* quaternion to be transmitted */ in encodeOrientPacketStream() local
359 fq.q0 = 1.0F; in encodeOrientPacketStream()
360 fq.q1 = fq.q2 = fq.q3 = 0.0F; in encodeOrientPacketStream()
370 … readAlgoParams((SV_ptr)&sfg->SV_9DOF_GBY_KALMAN, &fq, &iPhi, &iThe, &iRho, iOmega, &isystick); in encodeOrientPacketStream()
375 scratch16 = (int16_t) (fq.q0 * 30000.0F); in encodeOrientPacketStream()
377 scratch16 = (int16_t) (fq.q1 * 30000.0F); in encodeOrientPacketStream()
379 scratch16 = (int16_t) (fq.q2 * 30000.0F); in encodeOrientPacketStream()
[all …]
|
| D | orientaion_application_baremetal_agm04.c | 107 Quaternion *fq,
227 …SV_ptr data, Quaternion *fq, int16_t *iPhi, int16_t *iThe, int16_t *iRho, int16_t iOmega[], uint16… in readAlgoParams() argument
229 *fq = data->fq; in readAlgoParams()
270 Quaternion fq; /* quaternion to be transmitted */ in encodeOrientPacketStream() local
358 fq.q0 = 1.0F; in encodeOrientPacketStream()
359 fq.q1 = fq.q2 = fq.q3 = 0.0F; in encodeOrientPacketStream()
369 … readAlgoParams((SV_ptr)&sfg->SV_9DOF_GBY_KALMAN, &fq, &iPhi, &iThe, &iRho, iOmega, &isystick); in encodeOrientPacketStream()
374 scratch16 = (int16_t) (fq.q0 * 30000.0F); in encodeOrientPacketStream()
376 scratch16 = (int16_t) (fq.q1 * 30000.0F); in encodeOrientPacketStream()
378 scratch16 = (int16_t) (fq.q2 * 30000.0F); in encodeOrientPacketStream()
[all …]
|
| D | orientaion_application_baremetal_agmp03.c | 106 Quaternion *fq,
226 …SV_ptr data, Quaternion *fq, int16_t *iPhi, int16_t *iThe, int16_t *iRho, int16_t iOmega[], uint16… in readAlgoParams() argument
228 *fq = data->fq; in readAlgoParams()
269 Quaternion fq; /* quaternion to be transmitted */ in encodeOrientPacketStream() local
357 fq.q0 = 1.0F; in encodeOrientPacketStream()
358 fq.q1 = fq.q2 = fq.q3 = 0.0F; in encodeOrientPacketStream()
368 … readAlgoParams((SV_ptr)&sfg->SV_9DOF_GBY_KALMAN, &fq, &iPhi, &iThe, &iRho, iOmega, &isystick); in encodeOrientPacketStream()
373 scratch16 = (int16_t) (fq.q0 * 30000.0F); in encodeOrientPacketStream()
375 scratch16 = (int16_t) (fq.q1 * 30000.0F); in encodeOrientPacketStream()
377 scratch16 = (int16_t) (fq.q2 * 30000.0F); in encodeOrientPacketStream()
[all …]
|
| /hal_nxp-3.5.0/mcux/mcux-sdk/middleware/issdk/algorithms/sensorfusion/sources/ |
| D | output_stream.c | 79 Quaternion *fq, in readCommon() argument
85 *fq = data->fq; in readCommon()
124 Quaternion fq; // quaternion to be transmitted in CreateAndSendPackets() local
308 fq.q0 = 1.0F; in CreateAndSendPackets()
309 fq.q1 = fq.q2 = fq.q3 = 0.0F; in CreateAndSendPackets()
334 … readCommon((SV_ptr)&sfg->SV_3DOF_G_BASIC, &fq, &iPhi, &iThe, &iRho, iOmega, &isystick); in CreateAndSendPackets()
343 … readCommon((SV_ptr)&sfg->SV_3DOF_B_BASIC, &fq, &iPhi, &iThe, &iRho, iOmega, &isystick); in CreateAndSendPackets()
352 … readCommon((SV_ptr)&sfg->SV_3DOF_Y_BASIC, &fq, &iPhi, &iThe, &iRho, iOmega, &isystick); in CreateAndSendPackets()
362 … readCommon((SV_ptr)&sfg->SV_6DOF_GB_BASIC, &fq, &iPhi, &iThe, &iRho, iOmega, &isystick); in CreateAndSendPackets()
371 … readCommon((SV_ptr)&sfg->SV_6DOF_GY_KALMAN, &fq, &iPhi, &iThe, &iRho, iOmega, &isystick); in CreateAndSendPackets()
[all …]
|
| D | sensor_fusion.h | 286 Quaternion fq; ///< unfiltered orientation quaternion member
308 Quaternion fq; ///< unfiltered orientation quaternion member
324 Quaternion fq; ///< unfiltered orientation quaternion member
349 Quaternion fq; ///< unfiltered orientation quaternion member
442 Quaternion fq; ///< orientation quaternion member
|
| D | debug.c | 163 CurrentQ = sfg->SV_3DOF_Y_BASIC.fq; in ApplyPerturbation()
164 qAeqAxB(&(sfg->SV_3DOF_Y_BASIC.fq), &ftmpq); in ApplyPerturbation()
|
| D | fusion.c | 242 fqAeq1(&(pthisSV->fq)); in fInit_3DOF_Y_BASIC()
459 fQuaternionFromRotationMatrix(pthisSV->fR, &(pthisSV->fq)); in fRun_3DOF_G_BASIC()
460 fLPFOrientationQuaternion(&(pthisSV->fq), &(pthisSV->fLPq), pthisSV->flpf, in fRun_3DOF_G_BASIC()
508 fQuaternionFromRotationMatrix(pthisSV->fR, &(pthisSV->fq)); in fRun_3DOF_B_BASIC()
509 fLPFOrientationQuaternion(&(pthisSV->fq), &(pthisSV->fLPq), pthisSV->flpf, in fRun_3DOF_B_BASIC()
557 qAeqAxB(&(pthisSV->fq), &ftmpq); in fRun_3DOF_Y_BASIC()
558 fqAeqNormqA(&(pthisSV->fq)); in fRun_3DOF_Y_BASIC()
561 fRotationMatrixFromQuaternion(pthisSV->fR, &(pthisSV->fq)); in fRun_3DOF_Y_BASIC()
562 fRotationVectorDegFromQuaternion(&(pthisSV->fq), pthisSV->fRVec); in fRun_3DOF_Y_BASIC()
605 fQuaternionFromRotationMatrix(pthisSV->fR, &(pthisSV->fq)); in fRun_6DOF_GB_BASIC()
[all …]
|
