From 3d4c3356183686b97e8fa750b73ce727a59ff89f Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Tue, 27 Apr 2010 00:17:22 +0200 Subject: digital/avr/modules/math/geometry: add distance_point_point --- digital/avr/modules/math/geometry/distance.c | 9 +++++++++ 1 file changed, 9 insertions(+) (limited to 'digital/avr/modules/math/geometry/distance.c') diff --git a/digital/avr/modules/math/geometry/distance.c b/digital/avr/modules/math/geometry/distance.c index b5912aaa..348087fd 100644 --- a/digital/avr/modules/math/geometry/distance.c +++ b/digital/avr/modules/math/geometry/distance.c @@ -26,6 +26,15 @@ #include "distance.h" #include "modules/utils/utils.h" +#include "modules/math/fixed/fixed.h" + +int16_t +distance_point_point (vect_t *a, vect_t *b) +{ + int16_t dx = b->x - a->x; + int16_t dy = b->y - a->y; + return fixed_sqrt_ui32 (dx * dx + dy * dy); +} int16_t distance_segment_point (vect_t *a, vect_t *b, vect_t *p) -- cgit v1.2.3