// 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>
#include "ArrayInterTriangle.h"
#define FRAND (((float)rand()-(float)rand())/RAND_MAX)
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;
}
return true;
}
//定义屏幕拾取要用的变量。
//计算射线与平面交点的函数
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];
}
//计算模
double calMole(float a[3])
{
return sqrt(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(
fabs(
calMole(tempcross[0])+calMole(tempcross[1])+calMole(tempcross[2])-
calMole(tempcross[3])
)<0.00001
)return true;
return false;
}
//前面两个 表示一条射线，成功则返回point[3],true.
bool IsIntersectWithTriangle(float org[3],float dir[3],float a[3],float b[3],float c[3],float point[3],bool &IsFromFront)
{
float v1[3],v2[3];
float flat_4[4];
float flat[3];
VectBinus(a,b,v1);
VectBinus(b,c,v2);
_CrossProduct(v1,v2,flat);
cout<<endl;
cout<<"方向为：";
for(int i=0;i<3;i++)
{
cout<<dir[i]<<" ";
}
cout<<"法线为：";
for(i=0;i<3;i++)
{
cout<<flat[i]<<" ";
}
cout<<endl;
float dot=DotProduct(flat,dir);
cout<<"点积为:"<<endl;
cout<<dot<<endl;
if(dot<0)
IsFromFront=true;
else
IsFromFront=false;
if(dot==0)
{
return false;
}
if(flat[0]==0&&flat[1]==0&&flat[2]==0)
{
return false;
}
//根据法线与平面上的线的垂直关系，写出平面方程
flat_4[3]=a[0]*flat[0]+a[1]*flat[1]+a[2]*flat[2];
flat_4[0]=flat[0];
flat_4[1]=flat[1];
flat_4[2]=flat[2];
if(calInsert(org,dir,flat_4,point))
{
if(IsInTriangle(a,b,c,point)==true)return true;
else return false;
}else return false;
}
//求平面法线
void qiuFaXiangLiang(float a[3],float b[3],float c[3],float faXiangLiang[3])
{
float v1[3],v2[3];
//float flat[3];
VectBinus(a,b,v1);
VectBinus(b,c,v2);
_CrossProduct(v1,v2,faXiangLiang);
}
//求平面方程系数
bool qiuPingMianFangCheng(float a[3],float b[3],float c[3],float flat_4[4])
{
float v1[3],v2[3];
//float flat_4[4];
float flat[3];
VectBinus(a,b,v1);
VectBinus(b,c,v2);
_CrossProduct(v1,v2,flat);
if(flat[0]==0&&flat[1]==0&&flat[2]==0)
{
return false;
}
flat_4[3]=a[0]*flat[0]+a[1]*flat[1]+a[2]*flat[2];
flat_4[0]=flat[0];
flat_4[1]=flat[1];
flat_4[2]=flat[2];
return true;
}
bool IsTriangle(float a[3],float b[3],float c[3])
{
float v1[3],v2[3];
float flat[3];
VectBinus(a,b,v1);
VectBinus(a,c,v2);
_CrossProduct(v1,v2,flat);
if(calMole(flat)<0.000001)return false;
else return true;
}
#ifndef __ArrayInterTriangle_H__
#define __ArrayInterTriangle_H__
#define DotProduct(x,y) ((x)[0] * (y)[0] + (x)[1] * (y)[1] + (x)[2] * (y)[2]);
bool IsIntersectWithTriangle(float org[3],float dir[3],float a[3],float b[3],float c[3],float point[3],bool &IsFromFront);
void VectBinus(float a[3],float b[3],float c[3]);
bool qiuPingMianFangCheng(float a[3],float b[3],float c[3],float flat_4[4]);
void qiuFaXiangLiang(float a[3],float b[3],float c[3],float faXiangLiang[3]);
bool calInsert(float org[3],float dir[3],float flat[4],float intersection[3]);
bool IsTriangle(float a[3],float b[3],float c[3]);
#endif
分享到：
相关推荐
主要用typescript写的3D数学库。内容包含矩阵，向量，四元数，射线查询等。直接拖到工程里面即刻使用。
3D图形库实心渲染源代码 平底三角形 平顶三角形 任意三角形 物体实心渲染
从外行到3D开发内行的敲门砖3D 图形学 数学 3D游戏 3D开发
个人开发的java3D游戏数学库，欢迎大家下载研究. 这是数学引擎包； 改包提供对各种数学常量的支持和应用。 如:向量、矩阵、三角函数、视图窗口。 清单： 视图窗口(ViewWindow) 顶点(Point) 向量(Vector) 多边形...
3D图形开发所需要的基础数学代码，可以方便3D编程和开发学习
3D图形编程指南3D图形编程指南3D图形编程指南3D图形编程指南3D图形编程指南3D图形编程指南
TWaver HTML5 3D 制作的demo提供一个3d图形展示的基本代码。TWaver的3d图形组件库，小demo
很好的讲解DX9进行3D图形开发的书籍，适合一步步的学习，PDG格式。
计算机图形学-基于3D图形开发技术
3D图形库旋转矩阵的应用示例源代码 绕X,Y,Z轴同时旋转矩阵的生成 金字塔旋转DEMO示例
这是一整套数学库，包含了向量、矩阵及二维距离、三维距离、二维相交、三维相交的若干问题。
3D图形相关矩阵函数库示例源代码 1*3 3*3 1*4 4*4 矩阵加法、乘法、转置、求逆矩阵、求行列式
3D图形学入门 3D图形学入门 3D图形学入门 3D图形学入门
3D图形库向量函数库示例源代码 向量加减 点积 叉乘 归一 求范数 求夹角余弦
使用C++与openGL库编写的3D程序，实现三维图像效果，并可使用鼠标或键盘动态变换视角，（其中一个人物为电脑游戏CS中的模型），包含执行程序，使用VC或studio可直接打开工程文件运行
高清扫描版，完整，欢迎下载高清扫描版，完整，欢迎下载高清扫描版，完整，欢迎下载
3D MAX 教程 经典！ 图形3D MAX 教程 经典！ 图形3D MAX 教程 经典！ 图形3D MAX 教程 经典！ 图形
可信嵌入式3D图形系统关键技术的研究 博士论文 可信嵌入式3D图形系统关键技术的研究 可信嵌入式3D图形系统关键技术的研究
经典的3D数学入门教程!!!!高清pdf
3d 图形小引擎