From b8b18d982af8cc8e10372f90c6c7bff4f0b58f69 Mon Sep 17 00:00:00 2001 From: quou Date: Sat, 27 Jul 2024 15:43:22 +1000 Subject: vec_add, vec_sub and vec_dist --- maths.c | 23 +++++++++++++++++++++++ 1 file changed, 23 insertions(+) (limited to 'maths.c') diff --git a/maths.c b/maths.c index 70b354e..a0c9ed5 100644 --- a/maths.c +++ b/maths.c @@ -282,6 +282,29 @@ int* vec_nrm(int* d, const int* a, int c) { return d; } +int* vec_sub(int* d, const int* a, const int* b, int c) { + int i; + for (i = 0; i < c; i++) { + d[i] = a[i] - b[i]; + } + return d; +} + +int* vec_add(int* d, const int* a, const int* b, int c) { + int i; + for (i = 0; i < c; i++) { + d[i] = a[i] + b[i]; + } + return d; +} + +int vec_dist(int* w, const int* a, const int* b, int c) { + int dot; + vec_sub(w, a, b, c); + dot = vec_dot(w, w, c); + return fsqrt(dot); +} + int* persp(int* v, int asp) { v[2] += !v[2]; v[0] = ((v[0] << fbits) / v[2]); -- cgit v1.2.3-54-g00ecf