找出多边形的中心点
/** 找出多边形的中心点 */
b2Vec2 findCentroid(vector<b2Vec2> vertices) {
int verticesCount = vertices.size();
b2Vec2 c;
/** 终于找到罪魁祸首了，使用结构体的时候注意一定要初始化!!!血的教训!!! c.SetZero()等同于 c.Set(0.0f, 0.0f) */
c.SetZero();
float area = 0.0f;
float p1X = 0.0f;
float p1Y = 0.0f;
float inv3 = 1.0f/3.0f;
for(int i = 0; i < verticesCount; ++i) {
b2Vec2 p2 = vertices[i];
b2Vec2 p3 = (i+1)<verticesCount ? vertices[i+1] : vertices[0];
float e1X = p2.x - p1X;
float e1Y = p2.y - p1Y;
float e2X = p3.x - p1X;
float e2Y = p3.y - p1Y;
float D = e1X * e2Y - e1Y * e2X;
float triangleArea = 0.5f * D;
area += triangleArea;
c.x += triangleArea * inv3 * (p1X + p2.x + p3.x);
c.y += triangleArea * inv3 * (p1Y + p2.y + p3.y);
}
/**代替 box2d 做检查，我自己处理异常总比box2d报错直接导致程序不能再运行了的强~ */
if(area > FLT_EPSILON) {
c.x *=1.0f/area;
c.y *=1.0f/area;
} else {
//采取设定特殊值的方式告诉上一级这里出现状况了~
c.Set(12345.6789f,98765.4321f);
}
return c;
}
b2Vec2 findCentroid(b2Vec2 *vertices,int verticesCount) {
b2Vec2 c;
/** 终于找到罪魁祸首了，使用结构体的时候注意一定要初始化!!!血的教训!!! c.SetZero()等同于 c.Set(0.0f, 0.0f) */
c.SetZero();
float area = 0.0f;
float p1X = 0.0f;
float p1Y = 0.0f;
float inv3 = 1.0f/3.0f;
for(int i = 0; i < verticesCount; ++i) {
b2Vec2 p2 = vertices[i];
b2Vec2 p3 = (i+1)<verticesCount ? vertices[i+1] : vertices[0];
float e1X = p2.x - p1X;
float e1Y = p2.y - p1Y;
float e2X = p3.x - p1X;
float e2Y = p3.y - p1Y;
float D = e1X * e2Y - e1Y * e2X;
float triangleArea = 0.5f * D;
area += triangleArea;
c.x += triangleArea * inv3 * (p1X + p2.x + p3.x);
c.y += triangleArea * inv3 * (p1Y + p2.y + p3.y);
}
/**代替 box2d 做检查，我自己处理异常总比box2d报错直接导致程序不能再运行了的强~ */
if(area > FLT_EPSILON) {
c.x *=1.0f/area;
c.y *=1.0f/area;
} else {
//采取设定特殊值的方式告诉上一级这里出现状况了~
c.Set(12345.6789f,98765.4321f);
NSLog(@"RayCastMultipleCallback这里出问题了~");
}
return c;
}