Before changing IMU config, now config from MRPT
Working in addPoligon, it does not get bad intersections very well
modifing vector ang
Angle meassure works fine
IsInside work perfectly, impruve App polygon
Improve detection of good vertex in add poligon
good vertex in add poligon works good(all 3D), VertexAng() now in glof, working in sort Vertex
init of sustantial change in sortvertex
Sort vertex works!!!! just need to finnish an exception in intersecction, (from intersection to intersection)
Optimizatio in sort vertex, now only works with 2D vectors
Optimizatio in sort vertex, now only works with 2D vectors
local commict start checking fusion p2p
modification 1
Mopdification2