UAVFlightSimulator/utils.cpp at master · parthp08/UAVFlightSimulator · GitHub

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
#include "utils.h"

std::vector<double> operator+(const std::vector<double> &lhs, const std::vector<double> &rhs)
{
	if (lhs.size() != rhs.size())
	{ // size check
		throw std::runtime_error("Can't add two vectors of different sizes");
	}

	std::vector<double> result;
	for (int i = 0; i < (int)lhs.size(); i++)
	{
		result.push_back(lhs.at(i) + rhs.at(i));
	}
	return result;
}

std::vector<double> operator-(const std::vector<double> &lhs, const std::vector<double> &rhs)
{
	if (lhs.size() != rhs.size())
	{ // size check
		throw std::runtime_error("Can't add two vectors of different sizes");
	}

	std::vector<double> result;
	for (int i = 0; i < (int)lhs.size(); i++)
	{
		result.push_back(lhs.at(i) - rhs.at(i));
	}
	return result;
}

std::vector<double> operator*(const double &n, const std::vector<double> &rhs)
{
	std::vector<double> result;
	for (int i = 0; i < (int)rhs.size(); i++)
	{
		result.push_back(rhs.at(i) * n);
	}
	return result;
}

std::vector<double> operator*(const std::vector<double> &lhs, const double &n)
{
	std::vector<double> result;
	for (int i = 0; i < (int)lhs.size(); i++)
	{
		result.push_back(lhs.at(i) * n);
	}
	return result;
}

std::vector<double> operator/(const std::vector<double> &lhs, const double &n)
{
	std::vector<double> result;
	for (int i = 0; i < (int)lhs.size(); i++)
	{
		result.push_back(lhs.at(i) / n);
	}
	return result;
}

std::vector<double> abs(const std::vector<double> &v)
{
	std::vector<double> other = v;
	for (double &i : other)
	{
		i >= 0 ? other.push_back(i) : other.push_back(-i);
	}
	return other;
}

double max(const std::vector<double> &v)
{
	return *std::max_element(std::begin(v), std::end(v));
}

double sign(const double &a)
{
	if (a >= 0.0)
	{
		return 1.0;
	}
	else
	{
		return -1.0;
	}
}