判断三角形与射线相交的完整代码。。。

最新推荐文章于 2023-03-30 13:05:58 发布
最新推荐文章于 2023-03-30 13:05:58 发布
阅读量231 收藏
点赞数
文章标签： J# C C++ C#

// Det.cpp : Defines the entry point for the console application.
//

#include "stdafx.h"
#define M 3//矩阵大小
#include <stdio.h>
#include <iostream.h>
#include <stdlib.h>
#include <math.h>
#include <conio.h>
float  hanglieshi(float array[M][M])
{//计算行列式
   float temp[M][2*M];
   int i,j,c,c1;
   float result=0,t=1;
   for(i=0;i<M;i++)
   {//构造临时矩阵，用来计算行列式
      for(j=0;j<2*M;j++)
      {
          temp[i][j]=array[i][j%M];
      }
   }
   for(c1=0;c1<M;c1++)
   {//计算正值
      i=0;
      j=c1;
      t=1;
      for(c=0;c<M;c++)
      {
         t*=temp[i][j];
         i++;
         j++;
      }
      result+=t;
   }
   for(c1=0;c1<M;c1++)
   {//计算负值
      i=M-1;
      j=c1;
      t=1;
      for(c=0;c<M;c++)
      {
          t*=temp[i][j];
          i--;
          j++;
      }
      result-=t;
   }
   return result;
}
void init(float array[M][M])
{//初始化矩阵，用随机值填充矩阵
   int i,j;
   float m=3.0;
   //randomize();
   for(i=0;i<M;i++)
      for(j=0;j<M;j++)
         array[i][j]=rand()%20000;
}
void output(float array[M][M])
{//输出矩阵
   int i,j;
   for(i=0;i<M;i++)
   {
      printf("\n\n");
      for(j=0;j<M;j++)
          printf("%4f",array[i][j]);
   }
}
//非齐次方程
bool jieXianXingFangCheng(float xishu[M][M+1],float fangChengjie[M])
{
 //函数所占用的空间量应该动态fenp
 float D[M][M];
 float Dn[M][M];
 //根据克莱姆法则，求得D
 for(int i=0;i<M;i++)
   for(int j=0;j<M;j++)
   {
    D[i][j]=xishu[i][j]; 
       Dn[i][j]=xishu[i][j]; 
   }
   if(hanglieshi(D)==0)return false;
    float tempVect[M];
 //下面求解：
    for(int m=0;m<M;m++)
 { //替换第m列的值
  for(i=0;i<M;i++)
  {
            tempVect[i]=Dn[i][m];
      Dn[i][m]=xishu[i][M];
   
  }
  fangChengjie[m]=hanglieshi(Dn)/hanglieshi(D);
  for(i=0;i<M;i++)
  {
            Dn[i][m]=tempVect[i]; 
  }
//  cout<<fangChengjie[m]<<endl;
 }
}
//定义屏幕拾取要用的变量。
//计算射线与平面交点的函数
bool calInsert(float org[3],float dir[3],float flat[4],float intersection[3]){
 float xishu[3][4];
 //定义三个数来表示是否该设为标准参考
 int cankao[3];
 bool flag=false;
 for(int i=0,j=1;i<3;i++)
 {
    if(dir[i]!=0&&!flag)    
    {
     cankao[0]=i;
   
     flag=true;
    }
    else
    {
     cankao[j]=i; 
   j++;
    }
 }
 if(!flag)return flag;
 for(i=0;i<2;i++){
  ///int x=i+1;
  //1,2为非参考降
  //系数为cankao[0],cankao[i+1],cankao[3-i];
  xishu[i][cankao[2-i]]=0;
  xishu[i][cankao[0]]=-dir[cankao[i+1]]/dir[cankao[0]];
  xishu[i][cankao[i+1]]=1;
  xishu[i][3]=org[cankao[i+1]]-dir[cankao[i+1]]*org[cankao[0]]/dir[cankao[0]];
 }
/* for(i=0;i<3;i++)
 { cout<<endl;
  for(j=0;j<4;j++)
  {
      cout<<xishu[i][j]<<"  ";
  }
 }
 */
 //第一行
 //x=nearPoint.x+n_vector.x*(y-nearPoint.y)/(farPoint.y-nearPoint.y);
 //z=nearPoint.z+n_vector.z*(y-nearPoint.y)/(farPoint.y-nearPoint.y);
 //xishu[cankao[1]][cankao[1]]=1;
// xishu[cankao[1]][1]=-dir[cankao[1]]/dir[cankao[0]];
 //xishu[cankao[1]][cankao[0]]=0;
 //xishu[cankao[1]][3]=org[cankao[1]]-dir[cankao[1]]*org[cankao[0]]/dir[cankao[]];
 //第二行


 //第三行是一个平面方程。。
 //
    //假设系数为a,b,c,常量为d
 //
 //float a ,b ,c, d;
    xishu[2][0]=flat[0];
    xishu[2][1]=flat[1];
 xishu[2][2]=flat[2];
 xishu[2][3]=flat[3];
    return jieXianXingFangCheng(xishu,intersection);
}
//下面的代码判断，平面上，一个点是否在三角形内。
//思路是求面积。面积之和是否与三角形相等。
//要用到求叉积 

void CrossProduct(float Vector1[3], float Vector2[3], float Cross[3])
{
 Cross[0] = Vector1[1] * Vector2[2] - Vector1[2] * Vector2[1];
 Cross[1] = Vector1[2] * Vector2[0] - Vector1[0] * Vector2[2];
 Cross[2] = Vector1[0] * Vector2[1] - Vector1[1] * Vector2[0];
}
void VectBinus(float a[3],float b[3],float c[3])
{
     c[0]=a[0]-b[0];
  c[1]=a[1]-b[1];
  c[2]=a[2]-b[2];
}
//计算模
float calMole(float a[3])
{
return a[0]*a[0]+a[1]*a[1]+a[2]*a[2];
}
bool IsInTriangle(float a[3],float b[3],float c[3],float point[3]){
    float  tempcross[4][3];
 float v1[3];
 float v2[3];
    VectBinus(a,point,v1);
    VectBinus(a,b,v2);
 CrossProduct(v1,v2,tempcross[0]);
    VectBinus(b,point,v1);
    VectBinus(b,c,v2);
 CrossProduct(v1,v2,tempcross[1]);
 VectBinus(c,point,v1);
    VectBinus(c,a,v2);
 CrossProduct(v1,v2,tempcross[2]);
 VectBinus(c,b,v1);
    VectBinus(c,a,v2);
 CrossProduct(v1,v2,tempcross[3]);
 //计算面积是否相等
    if(
  (
  calMole(tempcross[0])
  +calMole(tempcross[1])
  +calMole(tempcross[2])
  )==calMole(tempcross[3])
   )return true;
 return false;
}
void main()
{
   float xishu[M][M+1];
   float fangchengjie[M];
   for(int i=0;i<M;i++)
   {
   for(int j=0;j<M;j++)
   {
    if(i!=j)xishu[i][j]=0;
    else xishu[i][j]=1;
   }
   }
   for(i=0;i<M;i++)
    xishu[i][M]=1;
  // jieXianXingFangCheng(xishu,fangchengjie);
   float org[3]={0,0,0};
   float dir[3]={0,1,0};
   float xishuA[4]={0,1,0,4};
   float jiaodian[3];
calInsert(org,dir,xishuA,jiaodian);
for(i=0;i<3;i++){
 cout<<jiaodian[i]<<endl;
}
  // float array[M][M];
 //  clrscr();
  // init(array);
  // output(array);
  // printf("\n%d",hanglieshi(array));//输出矩阵行列式的值
}


   

// Det.cpp : Defines the entry point for the console application.
//

#include "stdafx.h"
#define M 3//矩阵大小
#include <stdio.h>
#include <iostream.h>
#include <stdlib.h>
#include <math.h>
#include <conio.h>
float  hanglieshi(float array[M][M])
{//计算行列式
   float temp[M][2*M];
   int i,j,c,c1;
   float result=0,t=1;
   for(i=0;i<M;i++)
   {//构造临时矩阵，用来计算行列式
      for(j=0;j<2*M;j++)
      {
          temp[i][j]=array[i][j%M];
      }
   }
   for(c1=0;c1<M;c1++)
   {//计算正值
      i=0;
      j=c1;
      t=1;
      for(c=0;c<M;c++)
      {
         t*=temp[i][j];
         i++;
         j++;
      }
      result+=t;
   }
   for(c1=0;c1<M;c1++)
   {//计算负值
      i=M-1;
      j=c1;
      t=1;
      for(c=0;c<M;c++)
      {
          t*=temp[i][j];
          i--;
          j++;
      }
      result-=t;
   }
   return result;
}
void init(float array[M][M])
{//初始化矩阵，用随机值填充矩阵
   int i,j;
   float m=3.0;
   //randomize();
   for(i=0;i<M;i++)
      for(j=0;j<M;j++)
         array[i][j]=rand()%20000;
}
void output(float array[M][M])
{//输出矩阵
   int i,j;
   for(i=0;i<M;i++)
   {
      printf("\n\n");
      for(j=0;j<M;j++)
          printf("%4f",array[i][j]);
   }
}
//非齐次方程
bool jieXianXingFangCheng(float xishu[M][M+1],float fangChengjie[M])
{
	//函数所占用的空间量应该动态fenp
	float D[M][M];
	float Dn[M][M];
	//根据克莱姆法则，求得D
	for(int i=0;i<M;i++)
			for(int j=0;j<M;j++)
			{
				D[i][j]=xishu[i][j];	
			    Dn[i][j]=xishu[i][j];	
			}
			if(hanglieshi(D)==0)return false;
    float tempVect[M];
	//下面求解：
    for(int m=0;m<M;m++)
	{	//替换第m列的值
		for(i=0;i<M;i++)
		{
            tempVect[i]=Dn[i][m];
		    Dn[i][m]=xishu[i][M];
			
		}
		fangChengjie[m]=hanglieshi(Dn)/hanglieshi(D);
		for(i=0;i<M;i++)
		{
            Dn[i][m]=tempVect[i];	
		}
//		cout<<fangChengjie[m]<<endl;
	}
}
//定义屏幕拾取要用的变量。
//计算射线与平面交点的函数
bool calInsert(float org[3],float dir[3],float flat[4],float intersection[3]){
	float xishu[3][4];
	//定义三个数来表示是否该设为标准参考
	int cankao[3];
	bool flag=false;
	for(int i=0,j=1;i<3;i++)
	{
	   if(dir[i]!=0&&!flag)		   
	   {
		   cankao[0]=i;
		  
		   flag=true;
	   }
	   else
	   {
		   cankao[j]=i;	
			j++;
	   }
	}
	if(!flag)return flag;
	for(i=0;i<2;i++){
		///int x=i+1;
		//1,2为非参考降
		//系数为cankao[0],cankao[i+1],cankao[3-i];
		xishu[i][cankao[2-i]]=0;
		xishu[i][cankao[0]]=-dir[cankao[i+1]]/dir[cankao[0]];
		xishu[i][cankao[i+1]]=1;
		xishu[i][3]=org[cankao[i+1]]-dir[cankao[i+1]]*org[cankao[0]]/dir[cankao[0]];
	}
/*	for(i=0;i<3;i++)
	{	cout<<endl;
		for(j=0;j<4;j++)
		{
		    cout<<xishu[i][j]<<"  ";
		}
	}
	*/
	//第一行
	//x=nearPoint.x+n_vector.x*(y-nearPoint.y)/(farPoint.y-nearPoint.y);
	//z=nearPoint.z+n_vector.z*(y-nearPoint.y)/(farPoint.y-nearPoint.y);
	//xishu[cankao[1]][cankao[1]]=1;
//	xishu[cankao[1]][1]=-dir[cankao[1]]/dir[cankao[0]];
	//xishu[cankao[1]][cankao[0]]=0;
	//xishu[cankao[1]][3]=org[cankao[1]]-dir[cankao[1]]*org[cankao[0]]/dir[cankao[]];
	//第二行


	//第三行是一个平面方程。。
	//
    //假设系数为a,b,c,常量为d
	//
	//float a ,b ,c, d;
    xishu[2][0]=flat[0];
    xishu[2][1]=flat[1];
	xishu[2][2]=flat[2];
	xishu[2][3]=flat[3];
    return jieXianXingFangCheng(xishu,intersection);
}
//下面的代码判断，平面上，一个点是否在三角形内。
//思路是求面积。面积之和是否与三角形相等。
//要用到求叉积  

void CrossProduct(float Vector1[3], float Vector2[3], float Cross[3])
{
	Cross[0]	= Vector1[1] * Vector2[2] - Vector1[2] * Vector2[1];
	Cross[1]	= Vector1[2] * Vector2[0] - Vector1[0] * Vector2[2];
	Cross[2]	= Vector1[0] * Vector2[1] - Vector1[1] * Vector2[0];
}
void VectBinus(float a[3],float b[3],float c[3])
{
     c[0]=a[0]-b[0];
	 c[1]=a[1]-b[1];
	 c[2]=a[2]-b[2];
}
//计算模
float calMole(float a[3])
{
return a[0]*a[0]+a[1]*a[1]+a[2]*a[2];
}
bool IsInTriangle(float a[3],float b[3],float c[3],float point[3]){
    float  tempcross[4][3];
	float v1[3];
	float v2[3];
    VectBinus(a,point,v1);
    VectBinus(a,b,v2);
	CrossProduct(v1,v2,tempcross[0]);
    VectBinus(b,point,v1);
    VectBinus(b,c,v2);
	CrossProduct(v1,v2,tempcross[1]);
	VectBinus(c,point,v1);
    VectBinus(c,a,v2);
	CrossProduct(v1,v2,tempcross[2]);
	VectBinus(c,b,v1);
    VectBinus(c,a,v2);
	CrossProduct(v1,v2,tempcross[3]);
	//计算面积是否相等
    if(
		(
		calMole(tempcross[0])
		+calMole(tempcross[1])
		+calMole(tempcross[2])
		)==calMole(tempcross[3])
	  )return true;
	return false;
}
void main()
{
   float xishu[M][M+1];
   float fangchengjie[M];
   for(int i=0;i<M;i++)
   {
   for(int j=0;j<M;j++)
   {
	   if(i!=j)xishu[i][j]=0;
	   else xishu[i][j]=1;
   }
   }
   for(i=0;i<M;i++)
	   xishu[i][M]=1;
  // jieXianXingFangCheng(xishu,fangchengjie);
   float org[3]={0,0,0};
   float dir[3]={0,1,0};
   float xishuA[4]={0,1,0,4};
   float jiaodian[3];
calInsert(org,dir,xishuA,jiaodian);
for(i=0;i<3;i++){
 cout<<jiaodian[i]<<endl;
}
  // float array[M][M];
 //  clrscr();
  // init(array);
  // output(array);
  // printf("\n%d",hanglieshi(array));//输出矩阵行列式的值
}
//求平面方程的方法分析：
垂直求点积为0法：
(x-a)*u+(y-b)*v+(z-c)*k=0;
a,b,c 为平面上的一点。

 

daojin505
关注
  • 0
    点赞
  • 踩
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
射线与三角形求交，并判断是否在三角形内的完整代码（带测试）
daojin505的专栏
08-07 759
// Det.cpp : Defines the entry point for the console application. // #include "stdafx.h" #define M 3//矩阵大小 #include #include #include #include #include float hanglieshi(float array[M]
射线和三角形的相交检测（ray triangle intersection test）
03-15
射线和三角形的相交检测（ray triangle intersection test）
检测射线与三角形相交(3D)
程序员の墨梅
02-12 453
Theory: 这里有张图… Implement: static bool intersectSegmentTriangle(const float* sp, const float* sq, const float* a, const float* b, const float* c, ...
射线和三角形求交
averagePerson的博客
03-30 484
以下是一个简单的光追里射线和三角形求交的代码，使用了C++语言和OpenGL库。首先，我们需要定义一个射线类（Ray），包含起点（origin）和方向向量（direction）：复制接下来，我们定义一个三角形类（Triangle），包含三个点（p1, p2, p3），以及计算法向量（normal）的方法：复制在上面的代码中，我们使用了Möller–Trumbore算法来判断射线和三角形是否相交。如果相交，则返回交点到射线起点的距离t。
直线射线线段三角形求交代码
11-30
本主题主要关注的是直线、射线、线段以及三角形之间的相交检测，这些都是构建复杂图形算法的基础。以下是关于这些几何对象相交的基本概念、算法和C++实现细节。 **直线与直线的相交** 两条直线在二维平面上的相交...
triangle2triangle-Test.zip_三角形相交_两个三角形_平面相交
09-19
在图形渲染、碰撞检测、物理模拟等场景中，判断三角形是否相交是非常基础且关键的操作。 接下来是“两个三角形”的描述，这表明我们将研究的是两个独立的三角形的相互作用。两个三角形之间的关系不仅限于相交，还...
三角形相交检测（碰撞）
04-22
可以使用向量叉乘或射线-三角形相交测试来判断点是否在三角形内。 在VC++6.0中实现这个功能，我们需要创建一个用户界面，用户可以通过该界面输入或选择两个三角形的顶点坐标。这通常涉及以下步骤： 1. **界面设计*...
使用混合裁剪算法的射线三角形Bézier面片相交
03-15
使用混合裁剪算法的射线三角形Bézier面片相交
快速最小存储射线三角形相交算法(英文论文)
06-05
directx sample中pick采用的算法英文文章
射线与三角形相交检测
lq
08-09 1243
直观方法：判断射线是否与三角形所在的平面相交，如果相交，计算出射线与平面交点，如果交点在三角形内，则射线与三角形相交 接上一篇射线与平面相交检测，在这里直接使用射线与平面相交计算出来的交点坐标，判断交点坐标是否在三角形内。 判断一个点是否在三角形内，需要使用到Barycentric Coordinates（质心坐标系） 质心坐标系的基本概念: 几何结构中，图形中的点相对各顶点的位置，三角形中各顶点由(1, 0, 0)，(0, 1, 0)，(0, 0, 1)分别表示，则三角形内所有点的坐标 (...
3D空间中射线与三角形的交叉检测算法
热门推荐
i_dovelemon的专栏
08-01 1万+
详解Ray-Triangle交叉检测算法，并且提供代码示例，供您参考
【收藏好文】一文读懂射线与三角形相交算法Moller-Trumbore算法
oakchina的博客
04-27 1522
本期内容来自OAK人工智能俱乐部成员@阮培源（微信：阮PY），文章PDF可下载，由OAK中国整理发布。
光线与包围盒（AABB）的相交检测算法
u010603876的专栏
04-25 2423
转自：http://blog.csdn.net/u012325397/article/details/50807880  侵删 这里介绍两种算法，第一种比较容易理解 下面是Cocos2dx中实现Ray-AABB相交（碰撞）检测的算法，说明看注释 [cpp] view plain copy  print? bool
破片射线与三角形面元相交算法
最新发布
08-19
破片射线与三角形面元相交算法中，存在一种直接判断的方法，即Möller–Trumbore算法(M-T算法)[1][2。M-T算法通过射线与三角形的相交检测来确定破片射线是否与三角形面元相交。这个算法利用了射线与平面的相交检测...

“相关推荐”对你有帮助么？

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值