William Moberg
54 lines
1.9 KiB
C++
54 lines
1.9 KiB
C++
#include "Collision/Collision.h"
|
|
#include "Collision/CollisionSystem.h"
|
|
#include "Core/AABB.h"
|
|
#include "Rendering/Model.h"
|
|
|
|
void CollisionSystem::UpdateComponent(EntityWrapper& entity, ComponentWrapper& component, double dt)
|
|
{
|
|
if (!entity.HasComponent("Physics")) {
|
|
return;
|
|
}
|
|
ComponentWrapper& cPhysics = entity["Physics"];
|
|
|
|
boost::optional<EntityAABB> boundingBox = Collision::EntityAbsoluteAABB(entity);
|
|
if (!boundingBox) {
|
|
return;
|
|
}
|
|
ComponentWrapper& cTransform = entity["Transform"];
|
|
EntityAABB& boxA = *boundingBox;
|
|
|
|
// Collide against octree items
|
|
m_OctreeResult.clear();
|
|
m_Octree->ObjectsInSameRegion(*boundingBox, m_OctreeResult);
|
|
for (auto& boxB : m_OctreeResult) {
|
|
glm::vec3 resolutionVector;
|
|
if (boxA.Entity == boxB.Entity) {
|
|
continue;
|
|
}
|
|
|
|
if (boxB.Entity.HasComponent("Model") && Collision::AABBVsAABB(boxA, boxB)) {
|
|
//Here we know boxB is a entity with Collideable, AABB, and Model.
|
|
RawModel* model;
|
|
try {
|
|
model = ResourceManager::Load<RawModel, true>(boxB.Entity["Model"]["Resource"]);
|
|
} catch (const std::exception&) {
|
|
continue;
|
|
}
|
|
|
|
glm::mat4 modelMatrix = Transform::ModelMatrix(boxB.Entity);
|
|
|
|
glm::vec3 newVelocity = (glm::vec3)cPhysics["Velocity"];
|
|
if (Collision::AABBvsTriangles(boxA, model->m_Vertices, model->m_Indices, modelMatrix, newVelocity, resolutionVector)) {
|
|
(glm::vec3&)cTransform["Position"] += resolutionVector;
|
|
cPhysics["Velocity"] = newVelocity;
|
|
}
|
|
} else if (Collision::AABBVsAABB(boxA, boxB, resolutionVector)) {
|
|
//Enter here if boxB has no Model.
|
|
(glm::vec3&)cTransform["Position"] += resolutionVector;
|
|
if (resolutionVector.y > 0) {
|
|
((glm::vec3&)cPhysics["Velocity"]).y = 0.f;
|
|
}
|
|
}
|
|
}
|
|
}
|