POJ 1661 Help Jimmy(简单dp

#include <iostream>
#include <stdio.h>
#include <string.h>
#include <stack>
#include <queue>
#include <map>
#include <set>
#include <vector>
#include <math.h>
#include <bitset>
#include <algorithm>
#include <climits>

using namespace std;
const int N=1e3+10;
struct node{
    int x,y,h;
}p[N];
bool cmp(node a,node b){
    return a.h>b.h;
}
int t,n,x,y,m;
int dp[N][2];
int vis[N][2];
int main(){
    scanf("%d",&t);
    while(t--){
        scanf("%d%d%d%d",&n,&x,&y,&m);
        for(int i=1;i<=n;i++) scanf("%d%d%d",&p[i].x,&p[i].y,&p[i].h);
        p[0]={x,x,y};
        sort(p,p+1+n,cmp);
        memset(dp,0x3f,sizeof dp);
        memset(vis,0,sizeof vis);
        dp[0][0]=dp[0][1]=0;
        int mini=1e9;
        for(int i=0;i<=n;i++){
            for(int j=0;j<i;j++){
                if(p[j].x>=p[i].x&&p[j].x<=p[i].y&&p[j].h-p[i].h<=m&&vis[j][0]==0){
                    dp[i][0]=min(dp[i][0],dp[j][0]+p[j].x-p[i].x+p[j].h-p[i].h);
                    dp[i][1]=min(dp[i][1],dp[j][0]+p[i].y-p[j].x+p[j].h-p[i].h);
                    vis[j][0]=1;
                }
                if(p[j].y>=p[i].x&&p[j].y<=p[i].y&&p[j].h-p[i].h<=m&&vis[j][1]==0){
                    dp[i][0]=min(dp[i][0],dp[j][1]+p[j].y-p[i].x+p[j].h-p[i].h);
                    dp[i][1]=min(dp[i][1],dp[j][1]+p[i].y-p[j].y+p[j].h-p[i].h);
                    vis[j][1]=1;
                }
            }
        }
        for(int i=0;i<=n;i++){
//            int tp=min(dp[i][0]+p[i].h,dp[i][1]+p[i].h);
            if(p[i].h<=m&&vis[i][0]==0) mini=min(mini,dp[i][0]+p[i].h);
            if(p[i].h<=m&&vis[i][1]==0) mini=min(mini,dp[i][1]+p[i].h);
        }
        cout<<mini<<endl;

    }
}