2010-09-08 05:21:46 -03:00
|
|
|
// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: t -*-
|
|
|
|
|
2012-03-09 22:44:36 -04:00
|
|
|
#ifndef AP_MATH_H
|
|
|
|
#define AP_MATH_H
|
|
|
|
|
2010-09-08 05:21:46 -03:00
|
|
|
// Assorted useful math operations for ArduPilot(Mega)
|
|
|
|
|
2012-02-17 19:00:26 -04:00
|
|
|
#include <AP_Common.h>
|
2011-12-15 22:47:07 -04:00
|
|
|
#include <stdint.h>
|
2012-03-09 22:44:36 -04:00
|
|
|
#include "rotations.h"
|
2010-09-08 05:21:46 -03:00
|
|
|
#include "vector2.h"
|
|
|
|
#include "vector3.h"
|
|
|
|
#include "matrix3.h"
|
2012-03-04 23:31:47 -04:00
|
|
|
#include "quaternion.h"
|
2011-12-14 23:34:58 -04:00
|
|
|
#include "polygon.h"
|
2012-07-04 00:59:23 -03:00
|
|
|
#include <math.h>
|
2012-02-17 19:00:26 -04:00
|
|
|
|
|
|
|
// define AP_Param types AP_Vector3f and Ap_Matrix3f
|
|
|
|
AP_PARAMDEFV(Matrix3f, Matrix3f, AP_PARAM_MATRIX3F);
|
|
|
|
AP_PARAMDEFV(Vector3f, Vector3f, AP_PARAM_VECTOR3F);
|
2012-02-23 07:56:40 -04:00
|
|
|
|
|
|
|
// a varient of asin() that always gives a valid answer.
|
|
|
|
float safe_asin(float v);
|
2012-02-23 19:40:56 -04:00
|
|
|
|
|
|
|
// a varient of sqrt() that always gives a valid answer.
|
|
|
|
float safe_sqrt(float v);
|
2012-02-23 20:23:12 -04:00
|
|
|
|
2012-03-11 09:17:05 -03:00
|
|
|
// find a rotation that is the combination of two other
|
|
|
|
// rotations. This is used to allow us to add an overall board
|
|
|
|
// rotation to an existing rotation of a sensor such as the compass
|
|
|
|
enum Rotation rotation_combination(enum Rotation r1, enum Rotation r2, bool *found = NULL);
|
|
|
|
|
2012-07-03 20:19:36 -03:00
|
|
|
// return distance in meters between two locations
|
|
|
|
int32_t get_distance(const struct Location *loc1, const struct Location *loc2);
|
|
|
|
|
|
|
|
// return bearing in centi-degrees between two locations
|
|
|
|
int32_t get_bearing(const struct Location *loc1, const struct Location *loc2);
|
|
|
|
|
|
|
|
// see if location is past a line perpendicular to
|
|
|
|
// the line between point1 and point2. If point1 is
|
|
|
|
// our previous waypoint and point2 is our target waypoint
|
|
|
|
// then this function returns true if we have flown past
|
|
|
|
// the target waypoint
|
|
|
|
bool location_passed_point(struct Location &location,
|
|
|
|
struct Location &point1,
|
|
|
|
struct Location &point2);
|
|
|
|
|
|
|
|
#endif // AP_MATH_H
|
|
|
|
|