2d version of line/circle intersec function.
[blender-staging.git] / source / blender / python / generic / mathutils_geometry.c
1 /* 
2  * $Id$
3  *
4  * ***** BEGIN GPL LICENSE BLOCK *****
5  *
6  * This program is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU General Public License
8  * as published by the Free Software Foundation; either version 2
9  * of the License, or (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program; if not, write to the Free Software Foundation,
18  * Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
19  *
20  * The Original Code is Copyright (C) 2001-2002 by NaN Holding BV.
21  * All rights reserved.
22  *
23  * This is a new part of Blender.
24  *
25  * Contributor(s): Joseph Gilbert, Campbell Barton
26  *
27  * ***** END GPL LICENSE BLOCK *****
28  */
29
30 /** \file blender/python/generic/mathutils_geometry.c
31  *  \ingroup pygen
32  */
33
34
35 #include <Python.h>
36
37 #include "mathutils_geometry.h"
38
39 /* Used for PolyFill */
40 #include "MEM_guardedalloc.h"
41
42 #include "BLI_blenlib.h"
43 #include "BLI_boxpack2d.h"
44 #include "BLI_math.h"
45 #include "BLI_utildefines.h"
46  
47 #include "BKE_displist.h"
48
49 #include "BKE_curve.h"
50
51 #define SWAP_FLOAT(a, b, tmp) tmp=a; a=b; b=tmp
52 #define eps 0.000001
53
54
55 /*-------------------------DOC STRINGS ---------------------------*/
56 PyDoc_STRVAR(M_Geometry_doc,
57 "The Blender geometry module"
58 );
59
60 //---------------------------------INTERSECTION FUNCTIONS--------------------
61
62 PyDoc_STRVAR(M_Geometry_intersect_ray_tri_doc,
63 ".. function:: intersect_ray_tri(v1, v2, v3, ray, orig, clip=True)\n"
64 "\n"
65 "   Returns the intersection between a ray and a triangle, if possible, returns None otherwise.\n"
66 "\n"
67 "   :arg v1: Point1\n"
68 "   :type v1: :class:`mathutils.Vector`\n"
69 "   :arg v2: Point2\n"
70 "   :type v2: :class:`mathutils.Vector`\n"
71 "   :arg v3: Point3\n"
72 "   :type v3: :class:`mathutils.Vector`\n"
73 "   :arg ray: Direction of the projection\n"
74 "   :type ray: :class:`mathutils.Vector`\n"
75 "   :arg orig: Origin\n"
76 "   :type orig: :class:`mathutils.Vector`\n"
77 "   :arg clip: When False, don't restrict the intersection to the area of the triangle, use the infinite plane defined by the triangle.\n"
78 "   :type clip: boolean\n"
79 "   :return: The point of intersection or None if no intersection is found\n"
80 "   :rtype: :class:`mathutils.Vector` or None\n"
81 );
82 static PyObject *M_Geometry_intersect_ray_tri(PyObject *UNUSED(self), PyObject* args)
83 {
84         VectorObject *ray, *ray_off, *vec1, *vec2, *vec3;
85         float dir[3], orig[3], v1[3], v2[3], v3[3], e1[3], e2[3], pvec[3], tvec[3], qvec[3];
86         float det, inv_det, u, v, t;
87         int clip= 1;
88
89         if(!PyArg_ParseTuple(args, "O!O!O!O!O!|i:intersect_ray_tri", &vector_Type, &vec1, &vector_Type, &vec2, &vector_Type, &vec3, &vector_Type, &ray, &vector_Type, &ray_off , &clip)) {
90                 return NULL;
91         }
92         if(vec1->size != 3 || vec2->size != 3 || vec3->size != 3 || ray->size != 3 || ray_off->size != 3) {
93                 PyErr_SetString(PyExc_ValueError, "only 3D vectors for all parameters");
94                 return NULL;
95         }
96
97         if(BaseMath_ReadCallback(vec1) == -1 || BaseMath_ReadCallback(vec2) == -1 || BaseMath_ReadCallback(vec3) == -1 || BaseMath_ReadCallback(ray) == -1 || BaseMath_ReadCallback(ray_off) == -1)
98                 return NULL;
99
100         VECCOPY(v1, vec1->vec);
101         VECCOPY(v2, vec2->vec);
102         VECCOPY(v3, vec3->vec);
103
104         VECCOPY(dir, ray->vec);
105         normalize_v3(dir);
106
107         VECCOPY(orig, ray_off->vec);
108
109         /* find vectors for two edges sharing v1 */
110         sub_v3_v3v3(e1, v2, v1);
111         sub_v3_v3v3(e2, v3, v1);
112
113         /* begin calculating determinant - also used to calculated U parameter */
114         cross_v3_v3v3(pvec, dir, e2);
115
116         /* if determinant is near zero, ray lies in plane of triangle */
117         det= dot_v3v3(e1, pvec);
118
119         if (det > -0.000001f && det < 0.000001f) {
120                 Py_RETURN_NONE;
121         }
122
123         inv_det= 1.0f / det;
124
125         /* calculate distance from v1 to ray origin */
126         sub_v3_v3v3(tvec, orig, v1);
127
128         /* calculate U parameter and test bounds */
129         u= dot_v3v3(tvec, pvec) * inv_det;
130         if (clip && (u < 0.0f || u > 1.0f)) {
131                 Py_RETURN_NONE;
132         }
133
134         /* prepare to test the V parameter */
135         cross_v3_v3v3(qvec, tvec, e1);
136
137         /* calculate V parameter and test bounds */
138         v= dot_v3v3(dir, qvec) * inv_det;
139
140         if (clip && (v < 0.0f || u + v > 1.0f)) {
141                 Py_RETURN_NONE;
142         }
143
144         /* calculate t, ray intersects triangle */
145         t= dot_v3v3(e2, qvec) * inv_det;
146
147         mul_v3_fl(dir, t);
148         add_v3_v3v3(pvec, orig, dir);
149
150         return newVectorObject(pvec, 3, Py_NEW, NULL);
151 }
152
153 /* Line-Line intersection using algorithm from mathworld.wolfram.com */
154
155 PyDoc_STRVAR(M_Geometry_intersect_line_line_doc,
156 ".. function:: intersect_line_line(v1, v2, v3, v4)\n"
157 "\n"
158 "   Returns a tuple with the points on each line respectively closest to the other.\n"
159 "\n"
160 "   :arg v1: First point of the first line\n"
161 "   :type v1: :class:`mathutils.Vector`\n"
162 "   :arg v2: Second point of the first line\n"
163 "   :type v2: :class:`mathutils.Vector`\n"
164 "   :arg v3: First point of the second line\n"
165 "   :type v3: :class:`mathutils.Vector`\n"
166 "   :arg v4: Second point of the second line\n"
167 "   :type v4: :class:`mathutils.Vector`\n"
168 "   :rtype: tuple of :class:`mathutils.Vector`'s\n"
169 );
170 static PyObject *M_Geometry_intersect_line_line(PyObject *UNUSED(self), PyObject *args)
171 {
172         PyObject *tuple;
173         VectorObject *vec1, *vec2, *vec3, *vec4;
174         float v1[3], v2[3], v3[3], v4[3], i1[3], i2[3];
175
176         if(!PyArg_ParseTuple(args, "O!O!O!O!:intersect_line_line", &vector_Type, &vec1, &vector_Type, &vec2, &vector_Type, &vec3, &vector_Type, &vec4)) {
177                 return NULL;
178         }
179         if(vec1->size != vec2->size || vec1->size != vec3->size || vec3->size != vec2->size) {
180                 PyErr_SetString(PyExc_ValueError,"vectors must be of the same size");
181                 return NULL;
182         }
183
184         if(BaseMath_ReadCallback(vec1) == -1 || BaseMath_ReadCallback(vec2) == -1 || BaseMath_ReadCallback(vec3) == -1 || BaseMath_ReadCallback(vec4) == -1)
185                 return NULL;
186
187         if(vec1->size == 3 || vec1->size == 2) {
188                 int result;
189
190                 if (vec1->size == 3) {
191                         VECCOPY(v1, vec1->vec);
192                         VECCOPY(v2, vec2->vec);
193                         VECCOPY(v3, vec3->vec);
194                         VECCOPY(v4, vec4->vec);
195                 }
196                 else {
197                         v1[0]= vec1->vec[0];
198                         v1[1]= vec1->vec[1];
199                         v1[2]= 0.0f;
200
201                         v2[0]= vec2->vec[0];
202                         v2[1]= vec2->vec[1];
203                         v2[2]= 0.0f;
204
205                         v3[0]= vec3->vec[0];
206                         v3[1]= vec3->vec[1];
207                         v3[2]= 0.0f;
208
209                         v4[0]= vec4->vec[0];
210                         v4[1]= vec4->vec[1];
211                         v4[2]= 0.0f;
212                 }
213
214                 result= isect_line_line_v3(v1, v2, v3, v4, i1, i2);
215
216                 if (result == 0) {
217                         /* colinear */
218                         Py_RETURN_NONE;
219                 }
220                 else {
221                         tuple= PyTuple_New(2);
222                         PyTuple_SET_ITEM(tuple, 0, newVectorObject(i1, vec1->size, Py_NEW, NULL));
223                         PyTuple_SET_ITEM(tuple, 1, newVectorObject(i2, vec1->size, Py_NEW, NULL));
224                         return tuple;
225                 }
226         }
227         else {
228                 PyErr_SetString(PyExc_ValueError, "2D/3D vectors only");
229                 return NULL;
230         }
231 }
232
233
234
235
236 //----------------------------geometry.normal() -------------------
237 PyDoc_STRVAR(M_Geometry_normal_doc,
238 ".. function:: normal(v1, v2, v3, v4=None)\n"
239 "\n"
240 "   Returns the normal of the 3D tri or quad.\n"
241 "\n"
242 "   :arg v1: Point1\n"
243 "   :type v1: :class:`mathutils.Vector`\n"
244 "   :arg v2: Point2\n"
245 "   :type v2: :class:`mathutils.Vector`\n"
246 "   :arg v3: Point3\n"
247 "   :type v3: :class:`mathutils.Vector`\n"
248 "   :arg v4: Point4 (optional)\n"
249 "   :type v4: :class:`mathutils.Vector`\n"
250 "   :rtype: :class:`mathutils.Vector`\n"
251 );
252 static PyObject *M_Geometry_normal(PyObject *UNUSED(self), PyObject* args)
253 {
254         VectorObject *vec1, *vec2, *vec3, *vec4;
255         float n[3];
256
257         if(PyTuple_GET_SIZE(args) == 3) {
258                 if(!PyArg_ParseTuple(args, "O!O!O!:normal", &vector_Type, &vec1, &vector_Type, &vec2, &vector_Type, &vec3)) {
259                         return NULL;
260                 }
261                 if(vec1->size != vec2->size || vec1->size != vec3->size) {
262                         PyErr_SetString(PyExc_ValueError, "vectors must be of the same size");
263                         return NULL;
264                 }
265                 if(vec1->size < 3) {
266                         PyErr_SetString(PyExc_ValueError, "2D vectors unsupported");
267                         return NULL;
268                 }
269
270                 if(BaseMath_ReadCallback(vec1) == -1 || BaseMath_ReadCallback(vec2) == -1 || BaseMath_ReadCallback(vec3) == -1)
271                         return NULL;
272
273                 normal_tri_v3(n, vec1->vec, vec2->vec, vec3->vec);
274         }
275         else {
276                 if(!PyArg_ParseTuple(args, "O!O!O!O!:normal", &vector_Type, &vec1, &vector_Type, &vec2, &vector_Type, &vec3, &vector_Type, &vec4)) {
277                         return NULL;
278                 }
279                 if(vec1->size != vec2->size || vec1->size != vec3->size || vec1->size != vec4->size) {
280                         PyErr_SetString(PyExc_ValueError,"vectors must be of the same size");
281                         return NULL;
282                 }
283                 if(vec1->size < 3) {
284                         PyErr_SetString(PyExc_ValueError, "2D vectors unsupported");
285                         return NULL;
286                 }
287
288                 if(BaseMath_ReadCallback(vec1) == -1 || BaseMath_ReadCallback(vec2) == -1 || BaseMath_ReadCallback(vec3) == -1 || BaseMath_ReadCallback(vec4) == -1)
289                         return NULL;
290
291                 normal_quad_v3(n, vec1->vec, vec2->vec, vec3->vec, vec4->vec);
292         }
293
294         return newVectorObject(n, 3, Py_NEW, NULL);
295 }
296
297 //--------------------------------- AREA FUNCTIONS--------------------
298
299 PyDoc_STRVAR(M_Geometry_area_tri_doc,
300 ".. function:: area_tri(v1, v2, v3)\n"
301 "\n"
302 "   Returns the area size of the 2D or 3D triangle defined.\n"
303 "\n"
304 "   :arg v1: Point1\n"
305 "   :type v1: :class:`mathutils.Vector`\n"
306 "   :arg v2: Point2\n"
307 "   :type v2: :class:`mathutils.Vector`\n"
308 "   :arg v3: Point3\n"
309 "   :type v3: :class:`mathutils.Vector`\n"
310 "   :rtype: float\n"
311 );
312 static PyObject *M_Geometry_area_tri(PyObject *UNUSED(self), PyObject* args)
313 {
314         VectorObject *vec1, *vec2, *vec3;
315
316         if(!PyArg_ParseTuple(args, "O!O!O!:area_tri", &vector_Type, &vec1, &vector_Type, &vec2, &vector_Type, &vec3)) {
317                 return NULL;
318         }
319
320         if(vec1->size != vec2->size || vec1->size != vec3->size) {
321                 PyErr_SetString(PyExc_ValueError, "vectors must be of the same size");
322                 return NULL;
323         }
324
325         if(BaseMath_ReadCallback(vec1) == -1 || BaseMath_ReadCallback(vec2) == -1 || BaseMath_ReadCallback(vec3) == -1)
326                 return NULL;
327
328         if (vec1->size == 3) {
329                 return PyFloat_FromDouble(area_tri_v3(vec1->vec, vec2->vec, vec3->vec));
330         }
331         else if (vec1->size == 2) {
332                 return PyFloat_FromDouble(area_tri_v2(vec1->vec, vec2->vec, vec3->vec));
333         }
334         else {
335                 PyErr_SetString(PyExc_ValueError, "only 2D,3D vectors are supported");
336                 return NULL;
337         }
338 }
339
340 /*----------------------------------geometry.PolyFill() -------------------*/
341 PyDoc_STRVAR(M_Geometry_tesselate_polygon_doc,
342 ".. function:: tesselate_polygon(veclist_list)\n"
343 "\n"
344 "   Takes a list of polylines (each point a vector) and returns the point indices for a polyline filled with triangles.\n"
345 "\n"
346 "   :arg veclist_list: list of polylines\n"
347 "   :rtype: list\n"
348 );
349 /* PolyFill function, uses Blenders scanfill to fill multiple poly lines */
350 static PyObject *M_Geometry_tesselate_polygon(PyObject *UNUSED(self), PyObject *polyLineSeq)
351 {
352         PyObject *tri_list; /*return this list of tri's */
353         PyObject *polyLine, *polyVec;
354         int i, len_polylines, len_polypoints, ls_error= 0;
355
356         /* display listbase */
357         ListBase dispbase={NULL, NULL};
358         DispList *dl;
359         float *fp; /*pointer to the array of malloced dl->verts to set the points from the vectors */
360         int index, *dl_face, totpoints=0;
361
362         if(!PySequence_Check(polyLineSeq)) {
363                 PyErr_SetString(PyExc_TypeError, "expected a sequence of poly lines");
364                 return NULL;
365         }
366         
367         len_polylines= PySequence_Size(polyLineSeq);
368         
369         for(i= 0; i < len_polylines; ++i) {
370                 polyLine= PySequence_GetItem(polyLineSeq, i);
371                 if (!PySequence_Check(polyLine)) {
372                         freedisplist(&dispbase);
373                         Py_XDECREF(polyLine); /* may be null so use Py_XDECREF*/
374                         PyErr_SetString(PyExc_TypeError, "One or more of the polylines is not a sequence of mathutils.Vector's");
375                         return NULL;
376                 }
377                 
378                 len_polypoints= PySequence_Size(polyLine);
379                 if (len_polypoints>0) { /* dont bother adding edges as polylines */
380 #if 0
381                         if (EXPP_check_sequence_consistency(polyLine, &vector_Type) != 1) {
382                                 freedisplist(&dispbase);
383                                 Py_DECREF(polyLine);
384                                 PyErr_SetString(PyExc_TypeError, "A point in one of the polylines is not a mathutils.Vector type");
385                                 return NULL;
386                         }
387 #endif
388                         dl= MEM_callocN(sizeof(DispList), "poly disp");
389                         BLI_addtail(&dispbase, dl);
390                         dl->type= DL_INDEX3;
391                         dl->nr= len_polypoints;
392                         dl->type= DL_POLY;
393                         dl->parts= 1; /* no faces, 1 edge loop */
394                         dl->col= 0; /* no material */
395                         dl->verts= fp= MEM_callocN(sizeof(float)*3*len_polypoints, "dl verts");
396                         dl->index= MEM_callocN(sizeof(int)*3*len_polypoints, "dl index");
397                         
398                         for(index= 0; index<len_polypoints; ++index, fp+=3) {
399                                 polyVec= PySequence_GetItem(polyLine, index);
400                                 if(VectorObject_Check(polyVec)) {
401                                         
402                                         if(BaseMath_ReadCallback((VectorObject *)polyVec) == -1)
403                                                 ls_error= 1;
404                                         
405                                         fp[0]= ((VectorObject *)polyVec)->vec[0];
406                                         fp[1]= ((VectorObject *)polyVec)->vec[1];
407                                         if(((VectorObject *)polyVec)->size > 2)
408                                                 fp[2]= ((VectorObject *)polyVec)->vec[2];
409                                         else
410                                                 fp[2]= 0.0f; /* if its a 2d vector then set the z to be zero */
411                                 }
412                                 else {
413                                         ls_error= 1;
414                                 }
415                                 
416                                 totpoints++;
417                                 Py_DECREF(polyVec);
418                         }
419                 }
420                 Py_DECREF(polyLine);
421         }
422         
423         if(ls_error) {
424                 freedisplist(&dispbase); /* possible some dl was allocated */
425                 PyErr_SetString(PyExc_TypeError, "A point in one of the polylines is not a mathutils.Vector type");
426                 return NULL;
427         }
428         else if (totpoints) {
429                 /* now make the list to return */
430                 filldisplist(&dispbase, &dispbase, 0);
431                 
432                 /* The faces are stored in a new DisplayList
433                 thats added to the head of the listbase */
434                 dl= dispbase.first; 
435                 
436                 tri_list= PyList_New(dl->parts);
437                 if(!tri_list) {
438                         freedisplist(&dispbase);
439                         PyErr_SetString(PyExc_RuntimeError, "geometry.PolyFill failed to make a new list");
440                         return NULL;
441                 }
442                 
443                 index= 0;
444                 dl_face= dl->index;
445                 while(index < dl->parts) {
446                         PyList_SET_ITEM(tri_list, index, Py_BuildValue("iii", dl_face[0], dl_face[1], dl_face[2]));
447                         dl_face+= 3;
448                         index++;
449                 }
450                 freedisplist(&dispbase);
451         }
452         else {
453                 /* no points, do this so scripts dont barf */
454                 freedisplist(&dispbase); /* possible some dl was allocated */
455                 tri_list= PyList_New(0);
456         }
457         
458         return tri_list;
459 }
460
461 PyDoc_STRVAR(M_Geometry_intersect_line_line_2d_doc,
462 ".. function:: intersect_line_line_2d(lineA_p1, lineA_p2, lineB_p1, lineB_p2)\n"
463 "\n"
464 "   Takes 2 lines (as 4 vectors) and returns a vector for their point of intersection or None.\n"
465 "\n"
466 "   :arg lineA_p1: First point of the first line\n"
467 "   :type lineA_p1: :class:`mathutils.Vector`\n"
468 "   :arg lineA_p2: Second point of the first line\n"
469 "   :type lineA_p2: :class:`mathutils.Vector`\n"
470 "   :arg lineB_p1: First point of the second line\n"
471 "   :type lineB_p1: :class:`mathutils.Vector`\n"
472 "   :arg lineB_p2: Second point of the second line\n"
473 "   :type lineB_p2: :class:`mathutils.Vector`\n"
474 "   :return: The point of intersection or None when not found\n"
475 "   :rtype: :class:`mathutils.Vector` or None\n"
476 );
477 static PyObject *M_Geometry_intersect_line_line_2d(PyObject *UNUSED(self), PyObject* args)
478 {
479         VectorObject *line_a1, *line_a2, *line_b1, *line_b2;
480         float vi[2];
481         if(!PyArg_ParseTuple(args, "O!O!O!O!:intersect_line_line_2d",
482           &vector_Type, &line_a1,
483           &vector_Type, &line_a2,
484           &vector_Type, &line_b1,
485           &vector_Type, &line_b2)
486         ) {
487                 return NULL;
488         }
489         
490         if(BaseMath_ReadCallback(line_a1) == -1 || BaseMath_ReadCallback(line_a2) == -1 || BaseMath_ReadCallback(line_b1) == -1 || BaseMath_ReadCallback(line_b2) == -1)
491                 return NULL;
492
493         if(isect_seg_seg_v2_point(line_a1->vec, line_a2->vec, line_b1->vec, line_b2->vec, vi) == 1) {
494                 return newVectorObject(vi, 2, Py_NEW, NULL);
495         }
496         else {
497                 Py_RETURN_NONE;
498         }
499 }
500
501
502 PyDoc_STRVAR(M_Geometry_intersect_line_plane_doc,
503 ".. function:: intersect_line_plane(line_a, line_b, plane_co, plane_no, no_flip=False)\n"
504 "\n"
505 "   Takes 2 lines (as 4 vectors) and returns a vector for their point of intersection or None.\n"
506 "\n"
507 "   :arg line_a: First point of the first line\n"
508 "   :type line_a: :class:`mathutils.Vector`\n"
509 "   :arg line_b: Second point of the first line\n"
510 "   :type line_b: :class:`mathutils.Vector`\n"
511 "   :arg plane_co: A point on the plane\n"
512 "   :type plane_co: :class:`mathutils.Vector`\n"
513 "   :arg plane_no: The direction the plane is facing\n"
514 "   :type plane_no: :class:`mathutils.Vector`\n"
515 "   :arg no_flip: Always return an intersection on the directon defined bt line_a -> line_b\n"
516 "   :type no_flip: :boolean\n"
517 "   :return: The point of intersection or None when not found\n"
518 "   :rtype: :class:`mathutils.Vector` or None\n"
519 );
520 static PyObject *M_Geometry_intersect_line_plane(PyObject *UNUSED(self), PyObject* args)
521 {
522         VectorObject *line_a, *line_b, *plane_co, *plane_no;
523         int no_flip= 0;
524         float isect[3];
525         if(!PyArg_ParseTuple(args, "O!O!O!O!|i:intersect_line_plane",
526           &vector_Type, &line_a,
527           &vector_Type, &line_b,
528           &vector_Type, &plane_co,
529           &vector_Type, &plane_no,
530           &no_flip)
531         ) {
532                 return NULL;
533         }
534
535         if(             BaseMath_ReadCallback(line_a) == -1 ||
536                 BaseMath_ReadCallback(line_b) == -1 ||
537                 BaseMath_ReadCallback(plane_co) == -1 ||
538                 BaseMath_ReadCallback(plane_no) == -1
539         ) {
540                 return NULL;
541         }
542
543         if(ELEM4(2, line_a->size, line_b->size, plane_co->size, plane_no->size)) {
544                 PyErr_SetString(PyExc_RuntimeError, "geometry.intersect_line_plane(...) can't use 2D Vectors");
545                 return NULL;
546         }
547
548         if(isect_line_plane_v3(isect, line_a->vec, line_b->vec, plane_co->vec, plane_no->vec, no_flip) == 1) {
549                 return newVectorObject(isect, 3, Py_NEW, NULL);
550         }
551         else {
552                 Py_RETURN_NONE;
553         }
554 }
555
556
557 PyDoc_STRVAR(M_Geometry_intersect_line_sphere_doc,
558 ".. function:: intersect_line_sphere(line_a, line_b, sphere_co, sphere_radius, clip=True)\n"
559 "\n"
560 "   Takes a lines (as 2 vectors), a sphere as a point and a radius and\n"
561 "   returns the intersection\n"
562 "\n"
563 "   :arg line_a: First point of the first line\n"
564 "   :type line_a: :class:`mathutils.Vector`\n"
565 "   :arg line_b: Second point of the first line\n"
566 "   :type line_b: :class:`mathutils.Vector`\n"
567 "   :arg sphere_co: The center of the sphere\n"
568 "   :type sphere_co: :class:`mathutils.Vector`\n"
569 "   :arg sphere_radius: Radius of the sphere\n"
570 "   :type sphere_radius: sphere_radius\n"
571 "   :return: The intersection points as a pair of vectors or None when there is no intersection\n"
572 "   :rtype: A tuple pair containing :class:`mathutils.Vector` or None\n"
573 );
574 static PyObject *M_Geometry_intersect_line_sphere(PyObject *UNUSED(self), PyObject* args)
575 {
576         PyObject *ret;
577         VectorObject *line_a, *line_b, *sphere_co;
578         float sphere_radius;
579         int clip= TRUE;
580         float lambda;
581
582         float isect_a[3];
583         float isect_b[3];
584
585         if(!PyArg_ParseTuple(args, "O!O!O!f|i:intersect_line_sphere",
586           &vector_Type, &line_a,
587           &vector_Type, &line_b,
588           &vector_Type, &sphere_co,
589           &sphere_radius, &clip)
590         ) {
591                 return NULL;
592         }
593
594         if(             BaseMath_ReadCallback(line_a) == -1 ||
595                 BaseMath_ReadCallback(line_b) == -1 ||
596                 BaseMath_ReadCallback(sphere_co) == -1
597         ) {
598                 return NULL;
599         }
600
601         if(ELEM3(2, line_a->size, line_b->size, sphere_co->size)) {
602                 PyErr_SetString(PyExc_RuntimeError, "geometry.intersect_line_sphere(...) can't use 2D Vectors");
603                 return NULL;
604         }
605
606         ret= PyTuple_New(2);
607
608         switch(isect_line_sphere_v3(line_a->vec, line_b->vec, sphere_co->vec, sphere_radius, isect_a, isect_b)) {
609         case 1:
610                 /* ret 1 */
611                 if(!clip || (((lambda= line_point_factor_v3(isect_a, line_a->vec, line_b->vec)) >= 0.0f) && (lambda <= 1.0f))) {
612                         PyTuple_SET_ITEM(ret, 0,  newVectorObject(isect_a, 3, Py_NEW, NULL));
613                 }
614                 else {
615                         PyTuple_SET_ITEM(ret, 0,  Py_None); Py_INCREF(Py_None);
616                 }
617                 /* ret 2 */
618                 PyTuple_SET_ITEM(ret, 1,  Py_None); Py_INCREF(Py_None);
619                 break;
620         case 2:
621                 /* ret 1 */
622                 if(!clip || (((lambda= line_point_factor_v3(isect_a, line_a->vec, line_b->vec)) >= 0.0f) && (lambda <= 1.0f))) {
623                         PyTuple_SET_ITEM(ret, 0,  newVectorObject(isect_a, 3, Py_NEW, NULL));
624                 }
625                 else {
626                         PyTuple_SET_ITEM(ret, 0,  Py_None); Py_INCREF(Py_None);
627                 }
628                 /* ret 2 */
629                 if(!clip || (((lambda= line_point_factor_v3(isect_b, line_a->vec, line_b->vec)) >= 0.0f) && (lambda <= 1.0f))) {
630                         PyTuple_SET_ITEM(ret, 1,  newVectorObject(isect_b, 3, Py_NEW, NULL));
631                 }
632                 else {
633                         PyTuple_SET_ITEM(ret, 1,  Py_None); Py_INCREF(Py_None);
634                 }
635                 break;
636         default:
637                 PyTuple_SET_ITEM(ret, 0,  Py_None); Py_INCREF(Py_None);
638                 PyTuple_SET_ITEM(ret, 1,  Py_None); Py_INCREF(Py_None);
639         }
640
641         return ret;
642 }
643
644 PyDoc_STRVAR(M_Geometry_intersect_line_sphere_2d_doc,
645 ".. function:: intersect_line_sphere_2d(line_a, line_b, sphere_co, sphere_radius, clip=True)\n"
646 "\n"
647 "   Takes a lines (as 2 vectors), a sphere as a point and a radius and\n"
648 "   returns the intersection\n"
649 "\n"
650 "   :arg line_a: First point of the first line\n"
651 "   :type line_a: :class:`mathutils.Vector`\n"
652 "   :arg line_b: Second point of the first line\n"
653 "   :type line_b: :class:`mathutils.Vector`\n"
654 "   :arg sphere_co: The center of the sphere\n"
655 "   :type sphere_co: :class:`mathutils.Vector`\n"
656 "   :arg sphere_radius: Radius of the sphere\n"
657 "   :type sphere_radius: sphere_radius\n"
658 "   :return: The intersection points as a pair of vectors or None when there is no intersection\n"
659 "   :rtype: A tuple pair containing :class:`mathutils.Vector` or None\n"
660 );
661 static PyObject *M_Geometry_intersect_line_sphere_2d(PyObject *UNUSED(self), PyObject* args)
662 {
663         PyObject *ret;
664         VectorObject *line_a, *line_b, *sphere_co;
665         float sphere_radius;
666         int clip= TRUE;
667         float lambda;
668
669         float isect_a[3];
670         float isect_b[3];
671
672         if(!PyArg_ParseTuple(args, "O!O!O!f|i:intersect_line_sphere_2d",
673           &vector_Type, &line_a,
674           &vector_Type, &line_b,
675           &vector_Type, &sphere_co,
676           &sphere_radius, &clip)
677         ) {
678                 return NULL;
679         }
680
681         if(             BaseMath_ReadCallback(line_a) == -1 ||
682                 BaseMath_ReadCallback(line_b) == -1 ||
683                 BaseMath_ReadCallback(sphere_co) == -1
684         ) {
685                 return NULL;
686         }
687
688         ret= PyTuple_New(2);
689
690         switch(isect_line_sphere_v2(line_a->vec, line_b->vec, sphere_co->vec, sphere_radius, isect_a, isect_b)) {
691         case 1:
692                 /* ret 1 */
693                 if(!clip || (((lambda= line_point_factor_v3(isect_a, line_a->vec, line_b->vec)) >= 0.0f) && (lambda <= 1.0f))) {
694                         PyTuple_SET_ITEM(ret, 0,  newVectorObject(isect_a, 2, Py_NEW, NULL));
695                 }
696                 else {
697                         PyTuple_SET_ITEM(ret, 0,  Py_None); Py_INCREF(Py_None);
698                 }
699                 /* ret 2 */
700                 PyTuple_SET_ITEM(ret, 1,  Py_None); Py_INCREF(Py_None);
701                 break;
702         case 2:
703                 /* ret 1 */
704                 if(!clip || (((lambda= line_point_factor_v3(isect_a, line_a->vec, line_b->vec)) >= 0.0f) && (lambda <= 1.0f))) {
705                         PyTuple_SET_ITEM(ret, 0,  newVectorObject(isect_a, 2, Py_NEW, NULL));
706                 }
707                 else {
708                         PyTuple_SET_ITEM(ret, 0,  Py_None); Py_INCREF(Py_None);
709                 }
710                 /* ret 2 */
711                 if(!clip || (((lambda= line_point_factor_v3(isect_b, line_a->vec, line_b->vec)) >= 0.0f) && (lambda <= 1.0f))) {
712                         PyTuple_SET_ITEM(ret, 1,  newVectorObject(isect_b, 2, Py_NEW, NULL));
713                 }
714                 else {
715                         PyTuple_SET_ITEM(ret, 1,  Py_None); Py_INCREF(Py_None);
716                 }
717                 break;
718         default:
719                 PyTuple_SET_ITEM(ret, 0,  Py_None); Py_INCREF(Py_None);
720                 PyTuple_SET_ITEM(ret, 1,  Py_None); Py_INCREF(Py_None);
721         }
722
723         return ret;
724 }
725
726 PyDoc_STRVAR(M_Geometry_intersect_point_line_doc,
727 ".. function:: intersect_point_line(pt, line_p1, line_p2)\n"
728 "\n"
729 "   Takes a point and a line and returns a tuple with the closest point on the line and its distance from the first point of the line as a percentage of the length of the line.\n"
730 "\n"
731 "   :arg pt: Point\n"
732 "   :type pt: :class:`mathutils.Vector`\n"
733 "   :arg line_p1: First point of the line\n"
734 "   :type line_p1: :class:`mathutils.Vector`\n"
735 "   :arg line_p1: Second point of the line\n"
736 "   :type line_p1: :class:`mathutils.Vector`\n"
737 "   :rtype: (:class:`mathutils.Vector`, float)\n"
738 );
739 static PyObject *M_Geometry_intersect_point_line(PyObject *UNUSED(self), PyObject* args)
740 {
741         VectorObject *pt, *line_1, *line_2;
742         float pt_in[3], pt_out[3], l1[3], l2[3];
743         float lambda;
744         PyObject *ret;
745         
746         if(!PyArg_ParseTuple(args, "O!O!O!:intersect_point_line",
747                 &vector_Type, &pt,
748                 &vector_Type, &line_1,
749                 &vector_Type, &line_2)
750         ) {
751                 return NULL;
752         }
753         
754         if(BaseMath_ReadCallback(pt) == -1 || BaseMath_ReadCallback(line_1) == -1 || BaseMath_ReadCallback(line_2) == -1)
755                 return NULL;
756         
757         /* accept 2d verts */
758         if (pt->size==3) { VECCOPY(pt_in, pt->vec);}
759         else { pt_in[2]=0.0;    VECCOPY2D(pt_in, pt->vec) }
760         
761         if (line_1->size==3) { VECCOPY(l1, line_1->vec);}
762         else { l1[2]=0.0;       VECCOPY2D(l1, line_1->vec) }
763         
764         if (line_2->size==3) { VECCOPY(l2, line_2->vec);}
765         else { l2[2]=0.0;       VECCOPY2D(l2, line_2->vec) }
766         
767         /* do the calculation */
768         lambda= closest_to_line_v3(pt_out, pt_in, l1, l2);
769         
770         ret= PyTuple_New(2);
771         PyTuple_SET_ITEM(ret, 0, newVectorObject(pt_out, 3, Py_NEW, NULL));
772         PyTuple_SET_ITEM(ret, 1, PyFloat_FromDouble(lambda));
773         return ret;
774 }
775
776 PyDoc_STRVAR(M_Geometry_intersect_point_tri_2d_doc,
777 ".. function:: intersect_point_tri_2d(pt, tri_p1, tri_p2, tri_p3)\n"
778 "\n"
779 "   Takes 4 vectors (using only the x and y coordinates): one is the point and the next 3 define the triangle. Returns 1 if the point is within the triangle, otherwise 0.\n"
780 "\n"
781 "   :arg pt: Point\n"
782 "   :type v1: :class:`mathutils.Vector`\n"
783 "   :arg tri_p1: First point of the triangle\n"
784 "   :type tri_p1: :class:`mathutils.Vector`\n"
785 "   :arg tri_p2: Second point of the triangle\n"
786 "   :type tri_p2: :class:`mathutils.Vector`\n"
787 "   :arg tri_p3: Third point of the triangle\n"
788 "   :type tri_p3: :class:`mathutils.Vector`\n"
789 "   :rtype: int\n"
790 );
791 static PyObject *M_Geometry_intersect_point_tri_2d(PyObject *UNUSED(self), PyObject* args)
792 {
793         VectorObject *pt_vec, *tri_p1, *tri_p2, *tri_p3;
794         
795         if(!PyArg_ParseTuple(args, "O!O!O!O!:intersect_point_tri_2d",
796                   &vector_Type, &pt_vec,
797                   &vector_Type, &tri_p1,
798                   &vector_Type, &tri_p2,
799                   &vector_Type, &tri_p3)
800         ) {
801                 return NULL;
802         }
803         
804         if(BaseMath_ReadCallback(pt_vec) == -1 || BaseMath_ReadCallback(tri_p1) == -1 || BaseMath_ReadCallback(tri_p2) == -1 || BaseMath_ReadCallback(tri_p3) == -1)
805                 return NULL;
806         
807         return PyLong_FromLong(isect_point_tri_v2(pt_vec->vec, tri_p1->vec, tri_p2->vec, tri_p3->vec));
808 }
809
810 PyDoc_STRVAR(M_Geometry_intersect_point_quad_2d_doc,
811 ".. function:: intersect_point_quad_2d(pt, quad_p1, quad_p2, quad_p3, quad_p4)\n"
812 "\n"
813 "   Takes 5 vectors (using only the x and y coordinates): one is the point and the next 4 define the quad, only the x and y are used from the vectors. Returns 1 if the point is within the quad, otherwise 0.\n"
814 "\n"
815 "   :arg pt: Point\n"
816 "   :type v1: :class:`mathutils.Vector`\n"
817 "   :arg quad_p1: First point of the quad\n"
818 "   :type quad_p1: :class:`mathutils.Vector`\n"
819 "   :arg quad_p2: Second point of the quad\n"
820 "   :type quad_p2: :class:`mathutils.Vector`\n"
821 "   :arg quad_p3: Third point of the quad\n"
822 "   :type quad_p3: :class:`mathutils.Vector`\n"
823 "   :arg quad_p4: Forth point of the quad\n"
824 "   :type quad_p4: :class:`mathutils.Vector`\n"
825 "   :rtype: int\n"
826 );
827 static PyObject *M_Geometry_intersect_point_quad_2d(PyObject *UNUSED(self), PyObject* args)
828 {
829         VectorObject *pt_vec, *quad_p1, *quad_p2, *quad_p3, *quad_p4;
830         
831         if(!PyArg_ParseTuple(args, "O!O!O!O!O!:intersect_point_quad_2d",
832                   &vector_Type, &pt_vec,
833                   &vector_Type, &quad_p1,
834                   &vector_Type, &quad_p2,
835                   &vector_Type, &quad_p3,
836                   &vector_Type, &quad_p4)
837         ) {
838                 return NULL;
839         }
840         
841         if(BaseMath_ReadCallback(pt_vec) == -1 || BaseMath_ReadCallback(quad_p1) == -1 || BaseMath_ReadCallback(quad_p2) == -1 || BaseMath_ReadCallback(quad_p3) == -1 || BaseMath_ReadCallback(quad_p4) == -1)
842                 return NULL;
843         
844         return PyLong_FromLong(isect_point_quad_v2(pt_vec->vec, quad_p1->vec, quad_p2->vec, quad_p3->vec, quad_p4->vec));
845 }
846
847 static int boxPack_FromPyObject(PyObject *value, boxPack **boxarray)
848 {
849         int len, i;
850         PyObject *list_item, *item_1, *item_2;
851         boxPack *box;
852         
853         
854         /* Error checking must already be done */
855         if(!PyList_Check(value)) {
856                 PyErr_SetString(PyExc_TypeError, "can only back a list of [x, y, w, h]");
857                 return -1;
858         }
859         
860         len= PyList_Size(value);
861         
862         (*boxarray)= MEM_mallocN(len*sizeof(boxPack), "boxPack box");
863         
864         
865         for(i= 0; i < len; i++) {
866                 list_item= PyList_GET_ITEM(value, i);
867                 if(!PyList_Check(list_item) || PyList_Size(list_item) < 4) {
868                         MEM_freeN(*boxarray);
869                         PyErr_SetString(PyExc_TypeError, "can only pack a list of [x, y, w, h]");
870                         return -1;
871                 }
872                 
873                 box= (*boxarray)+i;
874                 
875                 item_1= PyList_GET_ITEM(list_item, 2);
876                 item_2= PyList_GET_ITEM(list_item, 3);
877                 
878                 box->w=  (float)PyFloat_AsDouble(item_1);
879                 box->h=  (float)PyFloat_AsDouble(item_2);
880                 box->index= i;
881
882                 if (box->w < 0.0f || box->h < 0.0f) {
883                         MEM_freeN(*boxarray);
884                         PyErr_SetString(PyExc_TypeError, "error parsing width and height values from list: [x, y, w, h], not numbers or below zero");
885                         return -1;
886                 }
887
888                 /* verts will be added later */
889         }
890         return 0;
891 }
892
893 static void boxPack_ToPyObject(PyObject *value, boxPack **boxarray)
894 {
895         int len, i;
896         PyObject *list_item;
897         boxPack *box;
898         
899         len= PyList_Size(value);
900         
901         for(i= 0; i < len; i++) {
902                 box= (*boxarray)+i;
903                 list_item= PyList_GET_ITEM(value, box->index);
904                 PyList_SET_ITEM(list_item, 0, PyFloat_FromDouble(box->x));
905                 PyList_SET_ITEM(list_item, 1, PyFloat_FromDouble(box->y));
906         }
907         MEM_freeN(*boxarray);
908 }
909
910 PyDoc_STRVAR(M_Geometry_box_pack_2d_doc,
911 ".. function:: box_pack_2d(boxes)\n"
912 "\n"
913 "   Returns the normal of the 3D tri or quad.\n"
914 "\n"
915 "   :arg boxes: list of boxes, each box is a list where the first 4 items are [x, y, width, height, ...] other items are ignored.\n"
916 "   :type boxes: list\n"
917 "   :return: the width and height of the packed bounding box\n"
918 "   :rtype: tuple, pair of floats\n"
919 );
920 static PyObject *M_Geometry_box_pack_2d(PyObject *UNUSED(self), PyObject *boxlist)
921 {
922         float tot_width= 0.0f, tot_height= 0.0f;
923         int len;
924
925         PyObject *ret;
926         
927         if(!PyList_Check(boxlist)) {
928                 PyErr_SetString(PyExc_TypeError, "expected a list of boxes [[x, y, w, h], ... ]");
929                 return NULL;
930         }
931
932         len= PyList_GET_SIZE(boxlist);
933         if (len) {
934                 boxPack *boxarray= NULL;
935                 if(boxPack_FromPyObject(boxlist, &boxarray) == -1) {
936                         return NULL; /* exception set */
937                 }
938
939                 /* Non Python function */
940                 boxPack2D(boxarray, len, &tot_width, &tot_height);
941
942                 boxPack_ToPyObject(boxlist, &boxarray);
943         }
944
945         ret= PyTuple_New(2);
946         PyTuple_SET_ITEM(ret, 0, PyFloat_FromDouble(tot_width));
947         PyTuple_SET_ITEM(ret, 1, PyFloat_FromDouble(tot_width));
948         return ret;
949 }
950
951 PyDoc_STRVAR(M_Geometry_interpolate_bezier_doc,
952 ".. function:: interpolate_bezier(knot1, handle1, handle2, knot2, resolution)\n"
953 "\n"
954 "   Interpolate a bezier spline segment.\n"
955 "\n"
956 "   :arg knot1: First bezier spline point.\n"
957 "   :type knot1: :class:`mathutils.Vector`\n"
958 "   :arg handle1: First bezier spline handle.\n"
959 "   :type handle1: :class:`mathutils.Vector`\n"
960 "   :arg handle2: Second bezier spline handle.\n"
961 "   :type handle2: :class:`mathutils.Vector`\n"
962 "   :arg knot2: Second bezier spline point.\n"
963 "   :type knot2: :class:`mathutils.Vector`\n"
964 "   :arg resolution: Number of points to return.\n"
965 "   :type resolution: int\n"
966 "   :return: The interpolated points\n"
967 "   :rtype: list of :class:`mathutils.Vector`'s\n"
968 );
969 static PyObject *M_Geometry_interpolate_bezier(PyObject *UNUSED(self), PyObject* args)
970 {
971         VectorObject *vec_k1, *vec_h1, *vec_k2, *vec_h2;
972         int resolu;
973         int dims;
974         int i;
975         float *coord_array, *fp;
976         PyObject *list;
977         
978         float k1[4]= {0.0, 0.0, 0.0, 0.0};
979         float h1[4]= {0.0, 0.0, 0.0, 0.0};
980         float k2[4]= {0.0, 0.0, 0.0, 0.0};
981         float h2[4]= {0.0, 0.0, 0.0, 0.0};
982         
983         
984         if(!PyArg_ParseTuple(args, "O!O!O!O!i:interpolate_bezier",
985           &vector_Type, &vec_k1,
986           &vector_Type, &vec_h1,
987           &vector_Type, &vec_h2,
988           &vector_Type, &vec_k2, &resolu)
989         ) {
990                 return NULL;
991         }
992
993         if(resolu <= 1) {
994                 PyErr_SetString(PyExc_ValueError, "resolution must be 2 or over");
995                 return NULL;
996         }
997
998         if(BaseMath_ReadCallback(vec_k1) == -1 || BaseMath_ReadCallback(vec_h1) == -1 || BaseMath_ReadCallback(vec_k2) == -1 || BaseMath_ReadCallback(vec_h2) == -1)
999                 return NULL;
1000
1001         dims= MAX4(vec_k1->size, vec_h1->size, vec_h2->size, vec_k2->size);
1002         
1003         for(i=0; i < vec_k1->size; i++) k1[i]= vec_k1->vec[i];
1004         for(i=0; i < vec_h1->size; i++) h1[i]= vec_h1->vec[i];
1005         for(i=0; i < vec_k2->size; i++) k2[i]= vec_k2->vec[i];
1006         for(i=0; i < vec_h2->size; i++) h2[i]= vec_h2->vec[i];
1007         
1008         coord_array= MEM_callocN(dims * (resolu) * sizeof(float), "interpolate_bezier");
1009         for(i=0; i<dims; i++) {
1010                 forward_diff_bezier(k1[i], h1[i], h2[i], k2[i], coord_array+i, resolu-1, sizeof(float)*dims);
1011         }
1012         
1013         list= PyList_New(resolu);
1014         fp= coord_array;
1015         for(i=0; i<resolu; i++, fp= fp+dims) {
1016                 PyList_SET_ITEM(list, i, newVectorObject(fp, dims, Py_NEW, NULL));
1017         }
1018         MEM_freeN(coord_array);
1019         return list;
1020 }
1021
1022 PyDoc_STRVAR(M_Geometry_barycentric_transform_doc,
1023 ".. function:: barycentric_transform(point, tri_a1, tri_a2, tri_a3, tri_b1, tri_b2, tri_b3)\n"
1024 "\n"
1025 "   Return a transformed point, the transformation is defined by 2 triangles.\n"
1026 "\n"
1027 "   :arg point: The point to transform.\n"
1028 "   :type point: :class:`mathutils.Vector`\n"
1029 "   :arg tri_a1: source triangle vertex.\n"
1030 "   :type tri_a1: :class:`mathutils.Vector`\n"
1031 "   :arg tri_a2: source triangle vertex.\n"
1032 "   :type tri_a2: :class:`mathutils.Vector`\n"
1033 "   :arg tri_a3: source triangle vertex.\n"
1034 "   :type tri_a3: :class:`mathutils.Vector`\n"
1035 "   :arg tri_a1: target triangle vertex.\n"
1036 "   :type tri_a1: :class:`mathutils.Vector`\n"
1037 "   :arg tri_a2: target triangle vertex.\n"
1038 "   :type tri_a2: :class:`mathutils.Vector`\n"
1039 "   :arg tri_a3: target triangle vertex.\n"
1040 "   :type tri_a3: :class:`mathutils.Vector`\n"
1041 "   :return: The transformed point\n"
1042 "   :rtype: :class:`mathutils.Vector`'s\n"
1043 );
1044 static PyObject *M_Geometry_barycentric_transform(PyObject *UNUSED(self), PyObject *args)
1045 {
1046         VectorObject *vec_pt;
1047         VectorObject *vec_t1_tar, *vec_t2_tar, *vec_t3_tar;
1048         VectorObject *vec_t1_src, *vec_t2_src, *vec_t3_src;
1049         float vec[3];
1050
1051         if(!PyArg_ParseTuple(args, "O!O!O!O!O!O!O!:barycentric_transform",
1052                   &vector_Type, &vec_pt,
1053                   &vector_Type, &vec_t1_src,
1054                   &vector_Type, &vec_t2_src,
1055                   &vector_Type, &vec_t3_src,
1056                   &vector_Type, &vec_t1_tar,
1057                   &vector_Type, &vec_t2_tar,
1058                   &vector_Type, &vec_t3_tar)
1059         ) {
1060                 return NULL;
1061         }
1062
1063         if(     vec_pt->size != 3 ||
1064                 vec_t1_src->size != 3 ||
1065                 vec_t2_src->size != 3 ||
1066                 vec_t3_src->size != 3 ||
1067                 vec_t1_tar->size != 3 ||
1068                 vec_t2_tar->size != 3 ||
1069                 vec_t3_tar->size != 3)
1070         {
1071                 PyErr_SetString(PyExc_ValueError, "One of more of the vector arguments wasnt a 3D vector");
1072                 return NULL;
1073         }
1074
1075         barycentric_transform(vec, vec_pt->vec,
1076                         vec_t1_tar->vec, vec_t2_tar->vec, vec_t3_tar->vec,
1077                         vec_t1_src->vec, vec_t2_src->vec, vec_t3_src->vec);
1078
1079         return newVectorObject(vec, 3, Py_NEW, NULL);
1080 }
1081
1082 static PyMethodDef M_Geometry_methods[]= {
1083         {"intersect_ray_tri", (PyCFunction) M_Geometry_intersect_ray_tri, METH_VARARGS, M_Geometry_intersect_ray_tri_doc},
1084         {"intersect_point_line", (PyCFunction) M_Geometry_intersect_point_line, METH_VARARGS, M_Geometry_intersect_point_line_doc},
1085         {"intersect_point_tri_2d", (PyCFunction) M_Geometry_intersect_point_tri_2d, METH_VARARGS, M_Geometry_intersect_point_tri_2d_doc},
1086         {"intersect_point_quad_2d", (PyCFunction) M_Geometry_intersect_point_quad_2d, METH_VARARGS, M_Geometry_intersect_point_quad_2d_doc},
1087         {"intersect_line_line", (PyCFunction) M_Geometry_intersect_line_line, METH_VARARGS, M_Geometry_intersect_line_line_doc},
1088         {"intersect_line_line_2d", (PyCFunction) M_Geometry_intersect_line_line_2d, METH_VARARGS, M_Geometry_intersect_line_line_2d_doc},
1089         {"intersect_line_plane", (PyCFunction) M_Geometry_intersect_line_plane, METH_VARARGS, M_Geometry_intersect_line_plane_doc},
1090         {"intersect_line_sphere", (PyCFunction) M_Geometry_intersect_line_sphere, METH_VARARGS, M_Geometry_intersect_line_sphere_doc},
1091         {"intersect_line_sphere_2d", (PyCFunction) M_Geometry_intersect_line_sphere_2d, METH_VARARGS, M_Geometry_intersect_line_sphere_2d_doc},
1092         {"interpolate_bezier", (PyCFunction) M_Geometry_interpolate_bezier, METH_VARARGS, M_Geometry_interpolate_bezier_doc},
1093         {"area_tri", (PyCFunction) M_Geometry_area_tri, METH_VARARGS, M_Geometry_area_tri_doc},
1094         {"normal", (PyCFunction) M_Geometry_normal, METH_VARARGS, M_Geometry_normal_doc},
1095         {"tesselate_polygon", (PyCFunction) M_Geometry_tesselate_polygon, METH_O, M_Geometry_tesselate_polygon_doc},
1096         {"box_pack_2d", (PyCFunction) M_Geometry_box_pack_2d, METH_O, M_Geometry_box_pack_2d_doc},
1097         {"barycentric_transform", (PyCFunction) M_Geometry_barycentric_transform, METH_VARARGS, M_Geometry_barycentric_transform_doc},
1098         {NULL, NULL, 0, NULL}
1099 };
1100
1101 static struct PyModuleDef M_Geometry_module_def= {
1102         PyModuleDef_HEAD_INIT,
1103         "mathutils.geometry",  /* m_name */
1104         M_Geometry_doc,  /* m_doc */
1105         0,  /* m_size */
1106         M_Geometry_methods,  /* m_methods */
1107         NULL,  /* m_reload */
1108         NULL,  /* m_traverse */
1109         NULL,  /* m_clear */
1110         NULL,  /* m_free */
1111 };
1112
1113 /*----------------------------MODULE INIT-------------------------*/
1114 PyMODINIT_FUNC BPyInit_mathutils_geometry(void)
1115 {
1116         PyObject *submodule= PyModule_Create(&M_Geometry_module_def);
1117         return submodule;
1118 }