1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
|
//*****************************************************************************
//
// vector.c - Functions for performing vector operations.
//
// Copyright (c) 2012-2014 Texas Instruments Incorporated. All rights reserved.
// Software License Agreement
//
// Texas Instruments (TI) is supplying this software for use solely and
// exclusively on TI's microcontroller products. The software is owned by
// TI and/or its suppliers, and is protected under applicable copyright
// laws. You may not combine this software with "viral" open-source
// software in order to form a larger program.
//
// THIS SOFTWARE IS PROVIDED "AS IS" AND WITH ALL FAULTS.
// NO WARRANTIES, WHETHER EXPRESS, IMPLIED OR STATUTORY, INCLUDING, BUT
// NOT LIMITED TO, IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
// A PARTICULAR PURPOSE APPLY TO THIS SOFTWARE. TI SHALL NOT, UNDER ANY
// CIRCUMSTANCES, BE LIABLE FOR SPECIAL, INCIDENTAL, OR CONSEQUENTIAL
// DAMAGES, FOR ANY REASON WHATSOEVER.
//
// This is part of revision 2.1.0.12573 of the Tiva Firmware Development Package.
//
//*****************************************************************************
#include "sensorlib/vector.h"
//*****************************************************************************
//
//! \addtogroup vector_api
//! @{
//
//*****************************************************************************
//*****************************************************************************
//
//! Computes the dot product of two vectors.
//!
//! \param pfVectorIn1 is the first vector.
//! \param pfVectorIn2 is the second vector.
//!
//! This function computes the dot product of two 3-dimensional vector.
//!
//! \return Returns the dot product of the two vectors.
//
//*****************************************************************************
float
VectorDotProduct(float pfVectorIn1[3], float pfVectorIn2[3])
{
//
// Compute and return the vector dot product.
//
return((pfVectorIn1[0] * pfVectorIn2[0]) +
(pfVectorIn1[1] * pfVectorIn2[1]) +
(pfVectorIn1[2] * pfVectorIn2[2]));
}
//*****************************************************************************
//
//! Computes the cross product of two vectors.
//!
//! \param pfVectorOut is the output vector.
//! \param pfVectorIn1 is the first vector.
//! \param pfVectorIn2 is the second vector.
//!
//! This function computes the cross product of two 3-dimensional vectors.
//!
//! \return None.
//
//*****************************************************************************
void
VectorCrossProduct(float pfVectorOut[3], float pfVectorIn1[3],
float pfVectorIn2[3])
{
//
// Compute the cross product of the input vectors.
//
pfVectorOut[0] = ((pfVectorIn1[1] * pfVectorIn2[2]) -
(pfVectorIn1[2] * pfVectorIn2[1]));
pfVectorOut[1] = ((pfVectorIn1[2] * pfVectorIn2[0]) -
(pfVectorIn1[0] * pfVectorIn2[2]));
pfVectorOut[2] = ((pfVectorIn1[0] * pfVectorIn2[1]) -
(pfVectorIn1[1] * pfVectorIn2[0]));
}
//*****************************************************************************
//
//! Scales a vector.
//!
//! \param pfVectorOut is the output vector.
//! \param pfVectorIn is the input vector.
//! \param fScale is the scale factor.
//!
//! This function scales a 3-dimensional vector by multiplying each of its
//! components by the scale factor.
//!
//! \return None.
//
//*****************************************************************************
void
VectorScale(float pfVectorOut[3], float pfVectorIn[3], float fScale)
{
//
// Scale each component of the vector by the scale factor.
//
pfVectorOut[0] = pfVectorIn[0] * fScale;
pfVectorOut[1] = pfVectorIn[1] * fScale;
pfVectorOut[2] = pfVectorIn[2] * fScale;
}
//*****************************************************************************
//
//! Adds two vectors.
//!
//! \param pfVectorOut is the output vector.
//! \param pfVectorIn1 is the first vector.
//! \param pfVectorIn2 is the second vector.
//!
//! This function adds two 3-dimensional vectors.
//!
//! \return None.
//
//*****************************************************************************
void
VectorAdd(float pfVectorOut[3], float pfVectorIn1[3], float pfVectorIn2[3])
{
//
// Add the components of the two vectors.
//
pfVectorOut[0] = pfVectorIn1[0] + pfVectorIn2[0];
pfVectorOut[1] = pfVectorIn1[1] + pfVectorIn2[1];
pfVectorOut[2] = pfVectorIn1[2] + pfVectorIn2[2];
}
//*****************************************************************************
//
// Close the Doxygen group.
//! @}
//
//*****************************************************************************
|
