update comm c-files
This commit is contained in:
@@ -7,7 +7,7 @@
|
|||||||
#ifndef MAVLINK_VERSION_H
|
#ifndef MAVLINK_VERSION_H
|
||||||
#define MAVLINK_VERSION_H
|
#define MAVLINK_VERSION_H
|
||||||
|
|
||||||
#define MAVLINK_BUILD_DATE "Sun Apr 29 2018"
|
#define MAVLINK_BUILD_DATE "Fri May 04 2018"
|
||||||
#define MAVLINK_WIRE_PROTOCOL_VERSION "2.0"
|
#define MAVLINK_WIRE_PROTOCOL_VERSION "2.0"
|
||||||
#define MAVLINK_MAX_DIALECT_PAYLOAD_SIZE 255
|
#define MAVLINK_MAX_DIALECT_PAYLOAD_SIZE 255
|
||||||
|
|
||||||
|
|||||||
+1
-1
@@ -7,7 +7,7 @@
|
|||||||
#ifndef MAVLINK_VERSION_H
|
#ifndef MAVLINK_VERSION_H
|
||||||
#define MAVLINK_VERSION_H
|
#define MAVLINK_VERSION_H
|
||||||
|
|
||||||
#define MAVLINK_BUILD_DATE "Sun Apr 29 2018"
|
#define MAVLINK_BUILD_DATE "Fri May 04 2018"
|
||||||
#define MAVLINK_WIRE_PROTOCOL_VERSION "2.0"
|
#define MAVLINK_WIRE_PROTOCOL_VERSION "2.0"
|
||||||
#define MAVLINK_MAX_DIALECT_PAYLOAD_SIZE 255
|
#define MAVLINK_MAX_DIALECT_PAYLOAD_SIZE 255
|
||||||
|
|
||||||
|
|||||||
+1
-1
@@ -7,7 +7,7 @@
|
|||||||
#ifndef MAVLINK_VERSION_H
|
#ifndef MAVLINK_VERSION_H
|
||||||
#define MAVLINK_VERSION_H
|
#define MAVLINK_VERSION_H
|
||||||
|
|
||||||
#define MAVLINK_BUILD_DATE "Sun Apr 29 2018"
|
#define MAVLINK_BUILD_DATE "Fri May 04 2018"
|
||||||
#define MAVLINK_WIRE_PROTOCOL_VERSION "2.0"
|
#define MAVLINK_WIRE_PROTOCOL_VERSION "2.0"
|
||||||
#define MAVLINK_MAX_DIALECT_PAYLOAD_SIZE 255
|
#define MAVLINK_MAX_DIALECT_PAYLOAD_SIZE 255
|
||||||
|
|
||||||
|
|||||||
@@ -38,14 +38,14 @@
|
|||||||
*/
|
*/
|
||||||
MAVLINK_HELPER void mavlink_quaternion_to_dcm(const float quaternion[4], float dcm[3][3])
|
MAVLINK_HELPER void mavlink_quaternion_to_dcm(const float quaternion[4], float dcm[3][3])
|
||||||
{
|
{
|
||||||
double a = quaternion[0];
|
float a = quaternion[0];
|
||||||
double b = quaternion[1];
|
float b = quaternion[1];
|
||||||
double c = quaternion[2];
|
float c = quaternion[2];
|
||||||
double d = quaternion[3];
|
float d = quaternion[3];
|
||||||
double aSq = a * a;
|
float aSq = a * a;
|
||||||
double bSq = b * b;
|
float bSq = b * b;
|
||||||
double cSq = c * c;
|
float cSq = c * c;
|
||||||
double dSq = d * d;
|
float dSq = d * d;
|
||||||
dcm[0][0] = aSq + bSq - cSq - dSq;
|
dcm[0][0] = aSq + bSq - cSq - dSq;
|
||||||
dcm[0][1] = 2 * (b * c - a * d);
|
dcm[0][1] = 2 * (b * c - a * d);
|
||||||
dcm[0][2] = 2 * (a * c + b * d);
|
dcm[0][2] = 2 * (a * c + b * d);
|
||||||
@@ -69,7 +69,7 @@ MAVLINK_HELPER void mavlink_quaternion_to_dcm(const float quaternion[4], float d
|
|||||||
MAVLINK_HELPER void mavlink_dcm_to_euler(const float dcm[3][3], float* roll, float* pitch, float* yaw)
|
MAVLINK_HELPER void mavlink_dcm_to_euler(const float dcm[3][3], float* roll, float* pitch, float* yaw)
|
||||||
{
|
{
|
||||||
float phi, theta, psi;
|
float phi, theta, psi;
|
||||||
theta = asin(-dcm[2][0]);
|
theta = asinf(-dcm[2][0]);
|
||||||
|
|
||||||
if (fabsf(theta - (float)M_PI_2) < 1.0e-3f) {
|
if (fabsf(theta - (float)M_PI_2) < 1.0e-3f) {
|
||||||
phi = 0.0f;
|
phi = 0.0f;
|
||||||
|
|||||||
+1
-1
@@ -7,7 +7,7 @@
|
|||||||
#ifndef MAVLINK_VERSION_H
|
#ifndef MAVLINK_VERSION_H
|
||||||
#define MAVLINK_VERSION_H
|
#define MAVLINK_VERSION_H
|
||||||
|
|
||||||
#define MAVLINK_BUILD_DATE "Sun Apr 29 2018"
|
#define MAVLINK_BUILD_DATE "Fri May 04 2018"
|
||||||
#define MAVLINK_WIRE_PROTOCOL_VERSION "2.0"
|
#define MAVLINK_WIRE_PROTOCOL_VERSION "2.0"
|
||||||
#define MAVLINK_MAX_DIALECT_PAYLOAD_SIZE 255
|
#define MAVLINK_MAX_DIALECT_PAYLOAD_SIZE 255
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user