Help Jimmy

"Help Jimmy" 是在下图所示的场景上完成的游戏。 

场景中包括多个长度和高度各不相同的平台。地面是最低的平台，高度为零，长度无限。 

Jimmy老鼠在时刻0从高于所有平台的某处开始下落，它的下落速度始终为1米/秒。当Jimmy落到某个平台上时，游戏者选择让它向左还是向右跑，它跑动的速度也是1米/秒。当Jimmy跑到平台的边缘时，开始继续下落。Jimmy每次下落的高度不能超过MAX米，不然就会摔死，游戏也会结束。 

设计一个程序，计算Jimmy到底地面时可能的最早时间。 

Input

第一行是测试数据的组数t（0 <= t <= 20）。每组测试数据的第一行是四个整数N，X，Y，MAX，用空格分隔。N是平台的数目（不包括地面），X和Y是Jimmy开始下落的位置的横竖坐标，MAX是一次下落的最大高度。接下来的N行每行描述一个平台，包括三个整数，X1[i]，X2[i]和H[i]。H[i]表示平台的高度，X1[i]和X2[i]表示平台左右端点的横坐标。1 <= N <= 1000，-20000 <= X, X1[i], X2[i] <= 20000，0 < H[i] < Y <= 20000（i = 1..N）。所有坐标的单位都是米。 

Jimmy的大小和平台的厚度均忽略不计。如果Jimmy恰好落在某个平台的边缘，被视为落在平台上。所有的平台均不重叠或相连。测试数据保证问题一定有解。 

Output

对输入的每组测试数据，输出一个整数，Jimmy到底地面时可能的最早时间。

Sample Input

1
3 8 17 20
0 10 8
0 10 13
4 14 3

Sample Output

23

#include <iostream>
#include <cstdio>
#include <cstdlib>
#include <cstring>
#include <algorithm>
#define inf 0x3f3f3f3f
using namespace std;
struct node
{
    int l,r,h;
} p[1200];
int cmp(node a,node b)
{
    return a.h>b.h;
}
bool book[50000];
int main()
{
    int t,n,x,y,MAX,i,j,pl[1200],pr[1200],k;
    scanf("%d",&t);
    while(t--)
    {
        memset(pl,inf,sizeof(pl));
        memset(pr,inf,sizeof(pr));
        scanf("%d %d %d %d",&n,&x,&y,&MAX);
        for(i=1; i<=n; i++)
        {
            scanf("%d %d %d",&p[i].l,&p[i].r,&p[i].h);
        }
        sort(p+1,p+1+n,cmp);
        int I=-1;
        for(i=1; i<=n; i++)
        {
            if(x>=p[i].l&&x<=p[i].r)
            {
                I=i;
                break;
            }
        }
        if(I==-1)
        {
            printf("%d\n",y);
            continue;
        }
        pl[I]=(y-p[I].h)+(x-p[I].l);
        pr[I]=(y-p[I].h)+(p[I].r-x);
        for(i=I+1; i<=n; i++)
        {
            memset(book,0,sizeof(book));
            for(j=i-1; j>=I; j--)
            {
                if(p[j].h-p[i].h<=MAX&&(p[j].l>=p[i].l&&p[j].l<=p[i].r)&&book[p[j].l+2009]==0)
                {
                    pl[i]=min(pl[j]+(p[j].l-p[i].l)+(p[j].h-p[i].h),pl[i]);
                    pr[i]=min(pl[j]+(p[i].r-p[j].l)+(p[j].h-p[i].h),pr[i]);
                }
                if(p[j].h-p[i].h<=MAX&&(p[j].r>=p[i].l&&p[j].r<=p[i].r)&&book[p[j].r+2009]==0)
                {
                    pl[i]=min(pr[j]+(p[j].r-p[i].l)+(p[j].h-p[i].h),pl[i]);
                    pr[i]=min(pr[j]+(p[i].r-p[j].r)+(p[j].h-p[i].h),pr[i]);
                }
                for(k=p[j].l; k<=p[j].r; k++)
                {
                    book[k+2009]=1;
                }
            }
        }
        int mi=inf;
        memset(book,0,sizeof(book));
        for(i=n; i>=I; i--)
        {
            if(p[i].h<=MAX&&book[p[i].l+2009]==0)
            {
                mi=min(mi,pl[i]+p[i].h);
            }
            if(p[i].h<=MAX&&book[p[i].r+2009]==0)
            {
                mi=min(mi,pr[i]+p[i].h);
            }
            for(k=p[i].l; k<=p[i].r; k++)
            {
                book[k+2009]=1;
            }
        }
        printf("%d\n",mi);
    }
}