spherecollider.cpp

#include "spherecollider.h"

SphereCollider::SphereCollider(const Vec2 pc_, const float rc_)
    : Collider(), pc(pc_), rc(rc_) {

}

SphereCollider::SphereCollider(const Vec2 pc_, const float rc_, const int role_)
    : Collider(role_), pc(pc_), rc(rc_) {}

const std::optional<StaticConstraint> SphereCollider::checkContact(Particle& collider) {
    Vec2 diff = collider.getExpPos()-this->getPoint();
    float sdf = diff.length() - this->getRadius();
    if (sdf<collider.getRad()){
        StaticConstraint sc;
        sc.nc = (1.0/diff.length())*diff;
        sc.pc = collider.getExpPos() - sdf * sc.nc;
        sc.part_ptr = &collider;
        return sc;
    }
    return {};
}

const Vec2 SphereCollider::getPoint() const {
    return pc;
}

const float SphereCollider::getRadius() const {
    return rc;
}