devZoGok/vb01
1
0
Fork 0
mirror of https://github.com/devZoGok/vb01.git synced 2026-08-26 19:43:30 +00:00
Code Issues Packages Projects Releases Wiki Activity

changed text and math classes

Browse Source
This commit is contained in:
devZoGok
2021-10-19 19:06:41 +03:00
parent 8f49bd1125
commit 72a9a33e7d
8 changed files with 233 additions and 211 deletions
Download Patch File Download Diff File Expand all files Collapse all files
ray.cpp
+45 -41
View File
@@ -6,59 +6,63 @@
using namespace std;
namespace vb01{
void retrieveCollisions(Vector3 rayPos, Vector3 rayDir,Node *node,std::vector<CollisionResult> &results, const float rayLength){
Vector3 pos=node->localToGlobalPosition(Vector3::VEC_ZERO);
Quaternion rot=node->localToGlobalOrientation(Quaternion::QUAT_W);
for(Mesh *m : node->getMeshes()){
const int numVerts=m->getNumVerts();
Mesh::Vertex *vertices=m->getVerts();
u32 *indices=m->getIndices();
void Ray::retrieveCollisions(Vector3 rayPos, Vector3 rayDir, Node *node, std::vector<CollisionResult> &results, const float rayLength){
castRay(rayPos, rayDir, node, results, rayLength);
for(Node *c : node->getChildren())
retrieveCollisions(rayPos, rayDir, c, results, rayLength);
}
for(int i=0;i<numVerts/3;i++){
Vector3 pointA=pos+rot*vertices[indices[i*3]].pos,pointB=pos+rot*vertices[indices[i*3+1]].pos,pointC=pos+rot*vertices[indices[i*3+2]].pos;
Vector3 hypVec=pointA-rayPos;
Vector3 perpVec=(pointB-pointA).cross(pointC-pointA);
float a1=hypVec.norm().getAngleBetween(perpVec.norm());
if(a1>PI/2){
a1=PI-a1;
perpVec=-perpVec;
void Ray::castRay(Vector3 rayPos, Vector3 rayDir, Node *node, vector<CollisionResult> &results, float rayLength){
Vector3 pos = node->localToGlobalPosition(Vector3::VEC_ZERO);
Quaternion rot = node->localToGlobalOrientation(Quaternion::QUAT_W);
for(Mesh *m : node->getMeshes()){
const int numVerts = m->getNumVerts();
Mesh::Vertex *vertices = m->getVerts();
u32 *indices = m->getIndices();
for(int i = 0; i < numVerts / 3; i++){
Vector3 pointA = pos + rot * vertices[indices[i * 3]].pos, pointB = pos + rot * vertices[indices[i * 3 + 1]].pos, pointC = pos + rot * vertices[indices[i * 3 + 2]].pos;
Vector3 hypVec = pointA - rayPos;
Vector3 perpVec = (pointB - pointA).cross(pointC - pointA);
float a1 = hypVec.norm().getAngleBetween(perpVec.norm());
if(a1 > PI / 2){
a1 = PI - a1;
perpVec = -perpVec;
}
float perpLine=hypVec.getLength()*cos(a1);
float a2=perpVec.norm().getAngleBetween(rayDir.norm());
if(a2<=PI/2){
float distance=perpLine/cos(a2);
if((distance<=rayLength&&rayLength!=.0)||rayLength==.0){
Vector3 contactPoint=rayPos+rayDir.norm()*distance;
float angleA=(pointB-pointA).norm().getAngleBetween((pointC-pointA).norm());
float angleB=(pointA-pointB).norm().getAngleBetween((pointC-pointB).norm());
float angleC=(pointB-pointC).norm().getAngleBetween((pointA-pointC).norm());
Vector3 bisecAVec=((pointB-pointA)+(pointC-pointA));
Vector3 bisecBVec=((pointA-pointB)+(pointC-pointB));
Vector3 bisecCVec=((pointB-pointC)+(pointA-pointC));
bool withinBisecA=(contactPoint-pointA).norm().getAngleBetween(bisecAVec.norm())<=angleA/2;
bool withinBisecB=(contactPoint-pointB).norm().getAngleBetween(bisecBVec.norm())<=angleB/2;
bool withinBisecC=(contactPoint-pointC).norm().getAngleBetween(bisecCVec.norm())<=angleC/2;
if(withinBisecA&&withinBisecB&&withinBisecC){
float perpLine = hypVec.getLength() * cos(a1);
float a2 = perpVec.norm().getAngleBetween(rayDir.norm());
if(a2 <= PI / 2){
float distance = perpLine / cos(a2);
if((distance <= rayLength && rayLength != .0) || rayLength == .0){
Vector3 contactPoint = rayPos + rayDir.norm() * distance;
float angleA = (pointB - pointA).norm().getAngleBetween((pointC - pointA).norm());
float angleB = (pointA - pointB).norm().getAngleBetween((pointC - pointB).norm());
float angleC = (pointB - pointC).norm().getAngleBetween((pointA - pointC).norm());
Vector3 bisecAVec = ((pointB - pointA) + (pointC - pointA));
Vector3 bisecBVec = ((pointA - pointB) + (pointC - pointB));
Vector3 bisecCVec = ((pointB - pointC) + (pointA - pointC));
bool withinBisecA = (contactPoint - pointA).norm().getAngleBetween(bisecAVec.norm()) <= angleA / 2;
bool withinBisecB = (contactPoint - pointB).norm().getAngleBetween(bisecBVec.norm()) <= angleB / 2;
bool withinBisecC = (contactPoint - pointC).norm().getAngleBetween(bisecCVec.norm()) <= angleC / 2;
if(withinBisecA && withinBisecB && withinBisecC){
CollisionResult result;
result.pos=contactPoint;
result.distance=distance;
result.mesh=m;
result.pos = contactPoint;
result.distance = distance;
result.mesh = m;
results.push_back(result);
}
}
}
}
}
for(Node *c : node->getChildren())
retrieveCollisions(rayPos,rayDir,c,results,rayLength);
}
void sortResults(std::vector<CollisionResult> &results){
void Ray::sortResults(std::vector<CollisionResult> &results){
if(!results.empty())
for(int i=0;i<results.size();i++){
for(int i2=i;i2<results.size();i2++)
if(results[i].distance>results[i2].distance)
swap(results[i],results[i2]);
for(int i = 0; i < results.size(); i++){
for(int i2 = i; i2 < results.size(); i2++)
if(results[i].distance > results[i2].distance)
swap(results[i], results[i2]);
}
}
}