我正在实现一些基础的三维物理引擎。对于球与球之间的碰撞,我遵循这个教程。我在处理两个移动中的球时遇到了问题。我想可能是我找到“缩短速度”的方式有问题。
bool collidingDSmove(Sphere sphere){
// Early Escape test: if the length of the movevec is less
// than distance between the centers of these circles minus
// their radii, there's no way they can hit.
在我的测试场景中,速度向量分别为(-2,-4,-2)和(1,2,1)。因此,“shortVel”实际上比原始速度更大。
vec3 shortVel = sphere.velocity.substract(velocity);
vec3 fromAtoBCenter = position.substract(sphere.position);
float distSquare = fromAtoBCenter.getLengthSquare();
float sumRadii = (radius + sphere.radius);
distSquare -= sumRadii*sumRadii;
if (shortVel.getLengthSquare() < distSquare){
return false;
}
// Normalize the movevec
vec3 N = shortVel.normalize();
// Find C, the vector from the center of the moving
// circle A to the center of B
vec3 C = sphere.position.substract(position);
// D = N . C = ||C|| * cos(angle between N and C)
float D = N.dot(C);
// Another early escape: Make sure that A is moving
// towards B! If the dot product between the movevec and
// B.center - A.center is less that or equal to 0,
// A isn't isn't moving towards B
if (D <= 0){
return false;
}
// Find the length of the vector C
float lengthCSquare = C.getLengthSquare();
float F = (lengthCSquare)-(D * D);
// Escape test: if the closest that A will get to B
// is more than the sum of their radii, there's no
// way they are going collide
float sumRadiiSquared = sumRadii * sumRadii;
if (F >= sumRadiiSquared){
return false;
}
// We now have F and sumRadii, two sides of a right triangle.
// Use these to find the third side, sqrt(T)
double T = sumRadiiSquared - F;
// If there is no such right triangle with sides length of
// sumRadii and sqrt(f), T will probably be less than 0.
// Better to check now than perform a square root of a
// negative number.
if (T < 0){
return false;
}
// Therefore the distance the circle has to travel along
// movevec is D - sqrt(T)
float distance = D - sqrt(T);
// Get the magnitude of the movement vector
float mag = velocity.getLength();
// Finally, make sure that the distance A has to move
// to touch B is not greater than the magnitude of the
// movement vector.
if (mag < distance){
return false;
}
//*** 数量不在0和1之间
float amount = shortVel.normalize().getLength() / velocity.getLength();
// Set the length of the movevec so that the circles will just
// touch
velocity = velocity.normalize().times(amount);
sphere.velocity = sphere.velocity.normalize().times(amount);
return true;
}
我的vec3类如下:
class vec3 {
public:
float x; float y; float z;
vec3() : x(0), y(0), z(0) { }
vec3 substract(vec3 v){
vec3 sub;
sub.x = x - v.x;
sub.y = y - v.y;
sub.z = z - v.z;
return sub;
}
float getLength() {
return sqrt(x*x + y*y + z*z);
}
float getLengthSquare() {
return x*x + y*y + z*z;
}
vec3 normalize(){
vec3 n;
n.x = x / getLength();
n.y = y / getLength();
n.z = z / getLength();
return n;
}
float dot(vec3 v) {
return x*v.x + y*v.y + z*v.z;
}
}
请问我在这里做错了什么?
以下是我的更新函数。其中deltaT是两帧之间经过的时间
void updateVelocity(double deltaT){
velocity.x = velocity.x + acceleration.x*deltaT;
velocity.y = velocity.y + acceleration.y*deltaT;
velocity.z = velocity.z + acceleration.z*deltaT;
}
void updatePosition(double deltaT){
position.x = position.x + velocity.x * deltaT + 0.5 * acceleration.x * deltaT * deltaT;
position.y = position.y + velocity.y * deltaT + 0.5 * acceleration.y * deltaT * deltaT;
position.z = position.z + velocity.z * deltaT + 0.5 * acceleration.z * deltaT * deltaT;
}
void update(double deltaT){
updateVelocity(deltaT);
updatePosition(deltaT);
}
vec3
有问题,要么完全跳过它。特别是,你没有为已完成的模块编写单元测试。此外,为什么不拿起铅笔和信封,逐步检查你的算法,看看是否一切都像应该的那样工作?不幸的是,这个问题也超出了话题范围,因为你询问代码有什么问题,但没有提供最小示例或任何预期的输入输出。 - luk32