C++ (Cpp) INT32_VECT3_ADD Examples

Example #1

File: pprz_geodetic_int.c Project: WenFly123/openPPZ

/* check if resolution of INT32_TRIG_FRAC (14) is enough here */
void ecef_of_enu_point_i(struct EcefCoor_i* ecef, struct LtpDef_i* def, struct EnuCoor_i* enu) {
  INT32_RMAT_TRANSP_VMULT(*ecef, def->ltp_of_ecef, *enu);//将enu坐标系转换成ecef坐标系,乘的是转置矩阵
  INT32_VECT3_ADD(*ecef, def->ecef);//将def里面存储的ecef加入到由enu转换后的ecef
}

Example #2

File: pprz_geodetic_int.c Project: HolyFox812/paparazzi

void ecef_of_enu_point_i(struct EcefCoor_i* ecef, struct LtpDef_i* def, struct EnuCoor_i* enu) {
  ecef_of_enu_vect_i(ecef, def, enu);
  INT32_VECT3_ADD(*ecef, def->ecef);
}

Example #3

File: pprz_geodetic_int.c Project: CheBuzz/paparazzi

/* check if resolution of INT32_TRIG_FRAC (14) is enough here */
void ecef_of_enu_point_i(struct EcefCoor_i* ecef, struct LtpDef_i* def, struct EnuCoor_i* enu) {
  INT32_RMAT_TRANSP_VMULT(*ecef, def->ltp_of_ecef, *enu);
  INT32_VECT3_ADD(*ecef, def->ecef);
}