Space Junk

最新推荐文章于 2024-02-03 20:33:17 发布

lzh823046544

最新推荐文章于 2024-02-03 20:33:17 发布

阅读量334

点赞数

CC 4.0 BY-SA版权

分类专栏： acm训练 UVALive

本文链接：https://blog.youkuaiyun.com/lzh823046544/article/details/52422090

acm训练同时被 2 个专栏收录

192 篇文章

订阅专栏

UVALive

16 篇文章

订阅专栏

本文介绍了一种计算三维空间中两个移动球体何时发生碰撞的方法，通过建立并求解一个关于时间t的二次方程来确定碰撞时刻。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

Space Junk

这里写图片描述
.
.
题意：给出两个球三位位置，半径以及速度向量，问什么时候能相撞。
.
.
解法：很明显这是一个不等式方程：
$\sqrt{(X1+VX1*t-X2-VX2*t)^2+(Y1+VY1*t-Y2-VY2*t)^2+ (Z1+VZ1*t-Z2-VZ2*t)^2}Z <= r1+r2$
然后这条式子两边平方解除t出来就好了。
.
.

#include <stdio.h>
#include <stdlib.h>
#include <math.h>

const double eps = 1e-8;
double a, b, c, X1, Y1, z1, X2, Y2, z2;
double vX1, vX2, vY1, vY2, vz1, vz2, r1, r2, t;

double sqr(double X) {
    return X*X;
}

double check(double a, double b, double c) {
    if (fabs(a) < eps) {
        if (fabs(b) < eps) {
            if (fabs(c) < eps) return 0;
            else return -1;
        }
        if ((-c)*b > -eps) return (-c)/b;
        else return -1;
    }
    if (sqr(b)-4*a*c < -eps) return -1;
    if ((-b+sqrt(fabs(sqr(b)-4*a*c)))/(2*a) < -eps) return -1;
    if ((-b-sqrt(fabs(sqr(b)-4*a*c)))/(2*a) < -eps)
        return (-b+sqrt(fabs(sqr(b)-4*a*c)))/(2*a);
    else return (-b-sqrt(fabs(sqr(b)-4*a*c)))/(2*a);
}

int main() {
    int tt;
    scanf("%d", &tt);
    while (tt--) {
        scanf("%lf %lf %lf %lf %lf %lf %lf", &X1, &Y1, &z1, &r1, &vX1, &vY1, &vz1);
        scanf("%lf %lf %lf %lf %lf %lf %lf", &X2, &Y2, &z2, &r2, &vX2, &vY2, &vz2);

        if (sqrt(sqr(X1-X2)+sqr(Y1-Y2)+sqr(z1-z2)) - (r1+r2) < eps) {
            printf("0.000\n");
            continue;
        }

        a = sqr(vX1-vX2)+sqr(vY1-vY2)+sqr(vz1-vz2);
        b = 2*((vX1-vX2)*(X1-X2)+(vY1-vY2)*(Y1-Y2)+(vz1-vz2)*(z1-z2));
        c = sqr(X1-X2)+sqr(Y1-Y2)+sqr(z1-z2)-sqr(r1+r2);
        t = check(a, b, c);
        if (fabs(t+1) < eps) printf("No collision\n");
        else printf("%.3lf\n", fabs(t));
    }
}