Sicily_How can I go

#include<iostream>
#include<cstdio>
#include<algorithm>
#include<cmath>
#include<cstring>
#include<queue>
#include<string>
using namespace std;
#define LL long long
bool vis[1005][1005];
int go[3][2]= {{1,1},{-1,1},{0,1}};
int n,L[1005],R[1005];
struct point
{
    int x,y,steps,dis;
    friend bool operator< (point n1, point n2)  //优先队列的比较函数，按照steps的大小从小到大排列排列队列中元素
    {
        return n1.steps > n2.steps;
    }
    point(int a,int b,int c,int d)
    {
        x=a,y=b,steps=c,dis=d;
    }
};
int bfs(int hehe)
{
    priority_queue<point> Q; //优先队列
    point f(hehe,0,0,n);
    Q.push(f);
    vis[hehe][0]=1;
    while(!Q.empty())
    {
        point s=Q.top();
        Q.pop();
        for(int i=0;i<3;++i)
        {
            int nx=s.x+go[i][0];
            int ny=s.y+go[i][1];
            int d=abs(ny-n);
            if(vis[nx][ny]||nx<R[ny]||nx>L[ny]||abs(ny-n)>=s.dis) //abs(ny-n)>=s.dis剪枝，如果s.dis大于终点和ny的值就不需要加入队列中了
                continue;
            if(ny==n) 
            {
                return s.steps; //为啥是return s.steps呢，因为有一个方向是（x,y+1)，也就是对每个点来说，它的下一个Y坐标必有不需要增加花费的X坐标
            }
            vis[nx][ny]=1;
            point next(nx,ny,s.steps+(i!=2),d); //i==2的方向是不需要增加1的，其他都是需要增加的
            Q.push(next);
        }
    }
    return -1;
}

int main()
{
 int t,i,s_x;
 cin>>t;
 while(t--)
 {
     scanf("%d",&n);
     for(i=1;i<=n;++i)
         scanf("%d",&L[i]); 
     for(i=1;i<=n;++i)
         scanf("%d",&R[i]);
      memset(vis,0,sizeof(vis));
     scanf("%d",&s_x);
     printf("%d\n",bfs(s_x));
 }
 return 0;
}