Curtis Belknap
/
LSM303DLHTest
LSM303DLH Test Program for get angle.
Fork of LSM303DLHTest by
LSM303DLH/vector.cpp
- Committer:
- cbelknap
- Date:
- 2015-03-18
- Revision:
- 5:05d5e64e76f2
- Parent:
- 3:f3796683b4c9
File content as of revision 5:05d5e64e76f2:
#include <vector.h> #include <math.h> void vector_cross(const vector *a,const vector *b, vector *out) { out->x = a->y*b->z - a->z*b->y; out->y = a->z*b->x - a->x*b->z; out->z = a->x*b->y - a->y*b->x; } float vector_dot(const vector *a,const vector *b) { return a->x*b->x+a->y*b->y+a->z*b->z; } void vector_normalize(vector *a) { float mag = sqrt(vector_dot(a,a)); a->x /= mag; a->y /= mag; a->z /= mag; }