首页 > 其他 > 详细

判断点在凸四边形内

时间:2016-06-16 11:45:40      阅读:270      评论:0      收藏:0      [点我收藏+]
#include <stdio.h>
#include <stdlib.h>

struct pt
{
	float x,y;
};

struct quat
{
	pt points[4];
};

float crossmulti2d( float x1, float y1, float x2, float y2)
{
	return x1 * y2 - x2 * y1;
}

bool inquat( quat _q, pt _pt)
{
	pt vec1, vec2;
	vec1.x = _q.points[1].x - _q.points[0].x;
	vec1.y = _q.points[1].y - _q.points[0].y;
	vec2.x = _pt.x - _q.points[0].x;
	vec2.y = _pt.y - _q.points[0].y;
	if( crossmulti2d( vec2.x, vec2.y, vec1.x, vec1.y ) < 0 )
	{
		return false;
	}
	vec1.x = _q.points[2].x - _q.points[1].x;
	vec1.y = _q.points[2].y - _q.points[1].y;
	vec2.x = _pt.x - _q.points[1].x;
	vec2.y = _pt.y - _q.points[1].y;
	if( crossmulti2d(vec2.x, vec2.y, vec1.x, vec1.y) < 0 )
	{
		return false;
	}
	vec1.x = _q.points[3].x - _q.points[2].x;
	vec1.y = _q.points[3].y - _q.points[2].y;
	vec2.x = _pt.x - _q.points[2].x;
	vec2.y = _pt.y - _q.points[2].y;
	if( crossmulti2d(vec2.x, vec2.y, vec1.x, vec1.y) < 0 )
	{
		return false;
	}
	vec1.x = _q.points[0].x - _q.points[3].x;
	vec1.y = _q.points[0].y - _q.points[3].y;
	vec2.x = _pt.x - _q.points[3].x;
	vec2.y = _pt.y - _q.points[3].y;
	if( crossmulti2d(vec2.x, vec2.y, vec1.x, vec1.y ) < 0 )
	{
		return false;
	}
	return true;
}

int main()
{
	quat shape = {
		{ {1, 1},{2, 1}, {1, 0},{0, 0} }
	};

	pt tests[] = {
		{0.0, 1.0},
		{1.0, 0.5},
		{1.5, 0},
		{1.5, 0.5},
		{1.5, 0.52},
		{1.5, 0.49}
		};
	for(int i =0; i<sizeof(tests)/sizeof(pt); ++i)
	{
		if( inquat(shape, tests[i]) == true )
		{
			printf("pass\n");
		}
		else
		{
			printf("failed\n");
		}
	}	
	return 0;
}


本文出自 “冰狐浪子的博客” 博客,请务必保留此出处http://bhlzlx.blog.51cto.com/3389283/1789801

判断点在凸四边形内

原文:http://bhlzlx.blog.51cto.com/3389283/1789801

(0)
(0)
   
举报
评论 一句话评论(0
关于我们 - 联系我们 - 留言反馈 - 联系我们:wmxa8@hotmail.com
© 2014 bubuko.com 版权所有
打开技术之扣,分享程序人生!