Compare commits
2 Commits
1a6fdf59ab
...
b6ea48ba47
Author | SHA1 | Date | |
---|---|---|---|
b6ea48ba47 | |||
cf7e4ccad0 |
@ -25,9 +25,11 @@
|
||||
|
||||
#include <stdio.h>
|
||||
#include "bounding-box.h"
|
||||
#include <math.h>
|
||||
|
||||
#define MIN(a,b) (((a) < (b)) ? (a) : (b)) /**< @brief Return smaller number */
|
||||
#define MAX(a,b) (((a) > (b)) ? (a) : (b)) /**< @brief Return bigger number */
|
||||
#define ABS_DBL(a) ((a) < 0 ? -(a) : (a))
|
||||
|
||||
void bounding_box_calculate_polygon(GList *vertices, conv_generic_to_vector_2d_t conv_func, union bounding_box *box)
|
||||
{
|
||||
@ -41,7 +43,10 @@ void bounding_box_calculate_polygon(GList *vertices, conv_generic_to_vector_2d_t
|
||||
|
||||
for (list_item = vertices; list_item != NULL; list_item = g_list_next(list_item)) {
|
||||
/* Convert generic vertex to vector_2d */
|
||||
conv_func((void *)list_item->data, &temp_vec);
|
||||
if (conv_func)
|
||||
conv_func((void *)list_item->data, &temp_vec);
|
||||
else
|
||||
vector_2d_copy(&temp_vec, (struct vector_2d *)list_item->data);
|
||||
|
||||
/* Update bounding coordinates with vertex */
|
||||
xmin = MIN(xmin, temp_vec.x);
|
||||
@ -79,3 +84,56 @@ void bounding_box_prepare_empty(union bounding_box *box)
|
||||
box->vectors.upper_right.x = DBL_MIN;
|
||||
box->vectors.upper_right.y = DBL_MIN;
|
||||
}
|
||||
|
||||
static void calculate_path_miter_points(struct vector_2d *a, struct vector_2d *b, struct vector_2d *c,
|
||||
struct vector_2d *m1, struct vector_2d *m2, double width)
|
||||
{
|
||||
double angle, angle_sin, u;
|
||||
struct vector_2d ba, bc, u_vec, v_vec, ba_norm;
|
||||
|
||||
if (!a || !b || !c || !m1 || !m2)
|
||||
return;
|
||||
|
||||
vector_2d_subtract(&ba, a, b);
|
||||
vector_2d_subtract(&bc, c, b);
|
||||
|
||||
angle = vector_2d_calculate_angle_between(&ba, &bc);
|
||||
|
||||
if (ABS_DBL(angle) < 0.05 || ABS_DBL(angle - M_PI) < 0.1) {
|
||||
/* Specail cases Don*/
|
||||
vector_2d_copy(&ba_norm, &ba);
|
||||
vector_2d_rotate(&ba_norm, DEG2RAD(90));
|
||||
vector_2d_normalize(&ba_norm);
|
||||
vector_2d_scale(&ba_norm, width/2.0);
|
||||
vector_2d_add(m1, b, &ba_norm);
|
||||
vector_2d_subtract(m2, b, &ba_norm);
|
||||
return;
|
||||
}
|
||||
angle_sin = sin(angle);
|
||||
u = width/(2*angle_sin);
|
||||
|
||||
vector_2d_copy(&u_vec, &ba);
|
||||
vector_2d_copy(&v_vec, &bc);
|
||||
vector_2d_normalize(&u_vec);
|
||||
vector_2d_normalize(&v_vec);
|
||||
vector_2d_scale(&u_vec, u);
|
||||
vector_2d_scale(&v_vec, u);
|
||||
|
||||
vector_2d_copy(m1, b);
|
||||
vector_2d_add(m1, m1, &u_vec);
|
||||
vector_2d_add(m1, m1, &v_vec);
|
||||
|
||||
vector_2d_copy(m2, b);
|
||||
vector_2d_subtract(m2, m2, &u_vec);
|
||||
vector_2d_subtract(m2, m2, &v_vec);
|
||||
}
|
||||
|
||||
void bounding_box_calculate_path_box(GList *vertices, conv_generic_to_vector_2d_t conv_func, union bounding_box *box)
|
||||
{
|
||||
|
||||
}
|
||||
|
||||
void bounding_box_update_point(union bounding_box *destination, conv_generic_to_vector_2d_t conv_func, void *pt)
|
||||
{
|
||||
|
||||
}
|
||||
|
@ -41,5 +41,5 @@ typedef void (*conv_generic_to_vector_2d_t)(void *, struct vector_2d *);
|
||||
void bounding_box_calculate_polygon(GList *vertices, conv_generic_to_vector_2d_t conv_func, union bounding_box *box);
|
||||
void bounding_box_update_box(union bounding_box *destination, union bounding_box *update);
|
||||
void bounding_box_prepare_empty(union bounding_box *box);
|
||||
|
||||
void bounding_box_update_point(union bounding_box *destination, conv_generic_to_vector_2d_t conv_func, void *pt);
|
||||
#endif /* _BOUNDING_BOX_H_ */
|
||||
|
@ -27,6 +27,8 @@
|
||||
#include <math.h>
|
||||
#include <stdlib.h>
|
||||
|
||||
#define ABS_DBL(a) ((a) < 0 ? -(a) : (a))
|
||||
|
||||
double vector_2d_scalar_multipy(struct vector_2d *a, struct vector_2d *b)
|
||||
{
|
||||
if (a && b)
|
||||
@ -35,7 +37,7 @@ double vector_2d_scalar_multipy(struct vector_2d *a, struct vector_2d *b)
|
||||
return 0.0;
|
||||
}
|
||||
|
||||
void vector_2d_normaize(struct vector_2d *vec)
|
||||
void vector_2d_normalize(struct vector_2d *vec)
|
||||
{
|
||||
double len;
|
||||
if (!vec)
|
||||
@ -56,14 +58,14 @@ void vector_2d_rotate(struct vector_2d *vec, double angle)
|
||||
sin_val = sin(angle);
|
||||
cos_val = cos(angle);
|
||||
|
||||
vecor_2d_copy(&temp, vec);
|
||||
vector_2d_copy(&temp, vec);
|
||||
|
||||
/* Apply rotation matrix */
|
||||
vec->x = (cos_val * temp.x) - (sin_val * temp.y);
|
||||
vec->y = (sin_val * temp.x) + (cos_val * temp.y);
|
||||
}
|
||||
|
||||
struct vector_2d *vecor_2d_copy(struct vector_2d *opt_res, struct vector_2d *vec)
|
||||
struct vector_2d *vector_2d_copy(struct vector_2d *opt_res, struct vector_2d *vec)
|
||||
{
|
||||
struct vector_2d *res;
|
||||
|
||||
@ -112,3 +114,30 @@ double vector_2d_abs(struct vector_2d *vec)
|
||||
}
|
||||
return len;
|
||||
}
|
||||
|
||||
double vector_2d_calculate_angle_between(struct vector_2d *a, struct vector_2d *b)
|
||||
{
|
||||
double cos_angle;
|
||||
|
||||
if (!a || !b)
|
||||
return 0.0;
|
||||
|
||||
cos_angle = ABS_DBL(vector_2d_scalar_multipy(a, b)) / (vector_2d_abs(a) * vector_2d_abs(b));
|
||||
return acos(cos_angle);
|
||||
}
|
||||
|
||||
void vector_2d_subtract(struct vector_2d *res, struct vector_2d *a, struct vector_2d *b)
|
||||
{
|
||||
if (res && a && b) {
|
||||
res->x = a->x - b->x;
|
||||
res->y = a->y - b->y;
|
||||
}
|
||||
}
|
||||
|
||||
void vector_2d_add(struct vector_2d *res, struct vector_2d *a, struct vector_2d *b)
|
||||
{
|
||||
if (res && a && b) {
|
||||
res->x = a->x +b->x;
|
||||
res->y = a->y + b->y;
|
||||
}
|
||||
}
|
||||
|
@ -26,19 +26,25 @@
|
||||
#ifndef _VECTOR_OPERATIONS_H_
|
||||
#define _VECTOR_OPERATIONS_H_
|
||||
|
||||
#include <math.h>
|
||||
|
||||
struct vector_2d {
|
||||
double x;
|
||||
double y;
|
||||
};
|
||||
|
||||
#define DEG2RAD(a) ((a)*M_PI/180.0)
|
||||
|
||||
double vector_2d_scalar_multipy(struct vector_2d *a, struct vector_2d *b);
|
||||
void vector_2d_normalize(struct vector_2d *vec);
|
||||
void vecor_2d_rotate(struct vector_2d *vec, double angle);
|
||||
struct vector_2d *vecor_2d_copy(struct vector_2d *opt_res, struct vector_2d *vec);
|
||||
void vector_2d_rotate(struct vector_2d *vec, double angle);
|
||||
struct vector_2d *vector_2d_copy(struct vector_2d *opt_res, struct vector_2d *vec);
|
||||
struct vector_2d *vector_2d_alloc(void);
|
||||
void vector_2d_free(struct vector_2d *vec);
|
||||
void vector_2d_scale(struct vector_2d *vec, double scale);
|
||||
double vector_2d_abs(struct vector_2d *vec);
|
||||
double vector_2d_calculate_angle_between(struct vector_2d *a, struct vector_2d *b);
|
||||
void vector_2d_subtract(struct vector_2d *res, struct vector_2d *a, struct vector_2d *b);
|
||||
void vector_2d_add(struct vector_2d *res, struct vector_2d *a, struct vector_2d *b);
|
||||
|
||||
#endif /* _VECTOR_OPERATIONS_H_ */
|
||||
|
Loading…
Reference in New Issue
Block a user