[UVALive] - 5816 Dhaka 2011 H - Treasure Hunt

本文介绍了一种基于重心偏移的贪心算法,适用于处理四个人移动导致的重心变化问题。通过计算重心偏移方向,算法实现了沿该方向进行贪心移动,以平衡重心位置。代码使用C++实现,包括点的定义、单位向量计算、移动距离查找等功能。

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

考虑到四个人的移动对于重心偏移的贡献相同,故沿重心偏移方向贪心走即可。

#include<bits/stdc++.h>
using namespace std;
typedef long double Double;
const Double eps=1e-25;
inline Double sqr(Double x){return x*x;}
inline double ip(){double x;scanf("%lf",&x);return x;}
inline void op(Double x,char c){printf("%.12lf%c",(double)x,c);}

struct point
{
    Double x,y;
    point() {}
    point(Double a,Double b) : x(a),y(b){}
    void in(){x=ip();y=ip();}
    void out(){op(x,' ');op(y,'\n');}
    #define cp const point &
    friend point operator + (cp a,cp b){return point(a.x+b.x,a.y+b.y);}
    friend point operator - (cp a,cp b){return point(a.x-b.x,a.y-b.y);}
    friend point operator * (cp a,Double b){return point(a.x*b,a.y*b);}
    Double len(){return sqrt(sqr(x)+sqr(y));}
}p[10],mid1,mid2,lk;

inline point unit(cp a)
{
    Double len=sqrt(sqr(a.x)+sqr(a.y));
    return point(a.x/len,a.y/len);
}

Double tot;

inline Double find(cp a,cp b,cp c)
{
    Double fm=(c.x-b.x)*lk.y+(b.y-c.y)*lk.x;
    if (fabs(fm)<eps) return 1e100;
    Double t=((c.y-b.y)*a.x+(b.x-c.x)*a.y+c.x*b.y-b.x*c.y)/fm;
    return t;
}

inline Double move(point &a)
{
    Double t,g[4]={find(a,p[5],p[6]),find(a,p[6],p[7]),find(a,p[7],p[8]),find(a,p[8],p[5])};
    sort(g,g+4);
    if (g[2]>1e90) t=g[1];
    else t=g[2];
	t=max(min(t,tot),(Double)0);
    a=a+lk*t;
    return t;
}

inline bool zero(point x){return fabs(x.x)<eps && fabs(x.y)<eps;}

inline void solve()
{
    for (int i=1;i<9;i++) p[i].in();
    bool flag=1;
    for (int i=1;i<9;i++) if (!zero(p[i])) flag=0;
    if (flag) exit(0);
    mid1=mid2=point(0,0);
    for (int i=1;i<5;i++) mid1=mid1+p[i];
    for (int i=5;i<9;i++) mid2=mid2+p[i];
    tot=(mid2-mid1).len();
    if (tot<eps)
    {
        for (int i=1;i<5;i++) p[i].out();
        return;
    }
    lk=unit(mid2-mid1);
    for (int i=1;i<5;i++) tot-=move(p[i]);
    for (int i=1;i<5;i++) p[i].out();
}

int main()
{
    while (1) solve(),puts("");
}
资源下载链接为: https://pan.quark.cn/s/67c535f75d4c 在机器人技术中,轨迹规划是实现机器人从一个位置平稳高效移动到另一个位置的核心环节。本资源提供了一套基于 MATLAB 的机器人轨迹规划程序,涵盖了关节空间和笛卡尔空间两种规划方式。MATLAB 是一种强大的数值计算与可视化工具,凭借其灵活易用的特点,常被用于机器人控制算法的开发与仿真。 关节空间轨迹规划主要关注机器人各关节角度的变化,生成从初始配置到目标配置的连续路径。其关键知识点包括: 关节变量:指机器人各关节的旋转角度或伸缩长度。 运动学逆解:通过数学方法从末端执行器的目标位置反推关节变量。 路径平滑:确保关节变量轨迹连续且无抖动,常用方法有 S 型曲线拟合、多项式插值等。 速度和加速度限制:考虑关节的实际物理限制,确保轨迹在允许的动态范围内。 碰撞避免:在规划过程中避免关节与其他物体发生碰撞。 笛卡尔空间轨迹规划直接处理机器人末端执行器在工作空间中的位置和姿态变化,涉及以下内容: 工作空间:机器人可到达的所有三维空间点的集合。 路径规划:在工作空间中找到一条从起点到终点的无碰撞路径。 障碍物表示:采用二维或三维网格、Voronoi 图、Octree 等数据结构表示工作空间中的障碍物。 轨迹生成:通过样条曲线、直线插值等方法生成平滑路径。 实时更新:在规划过程中实时检测并避开新出现的障碍物。 在 MATLAB 中实现上述规划方法,可以借助其内置函数和工具箱: 优化工具箱:用于解决运动学逆解和路径规划中的优化问题。 Simulink:可视化建模环境,适合构建和仿真复杂的控制系统。 ODE 求解器:如 ode45,用于求解机器人动力学方程和轨迹执行过程中的运动学问题。 在实际应用中,通常会结合关节空间和笛卡尔空间的规划方法。先在关节空间生成平滑轨迹,再通过运动学正解将关节轨迹转换为笛卡
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值