BFS40分 蒟蒻求大佬帮助

#include<bits/stdc++.h>
using namespace std;
int n,a,b,k[209];
struct node{
	int dat;
	int dep;
};
node data[40009],tmp;
const int up[3]={0,1,-1};
int head=0,tail=1,r;
int check(int w){
	if(data[head].dat+up[r]*k[data[head].dat]<=n&&data[head].dat+up[r]*k[data[head].dat]>=0)
		return 1;
	return 0;
}
int dupl(){
	for(int j=tail-1;j>0;j--)
	{
		if(data[tail].dat==data[j].dat)return 1;	
	}
	return 0;
}
int goal(){
	if(data[head].dat==b)return 1;
	return 0;
}
int main(){
	cin>>n>>a>>b;
	for(int i=1;i<=n;i++)
		cin>>k[i];
	data[1].dat=a;
	data[1].dep=0;
	while(head<tail){
		head++;
		for(r=1;r<=2;r++){
			if(check(r)){
				tail++;
				tmp.dat=data[head].dat;
				tmp.dat+=up[r]*k[data[head].dat];
				tmp.dep=data[head].dep+1;
				data[tail]=tmp;
				if(dupl())tail--;
				else if(goal()){cout<<data[tail].dep-1;return 0;} 
			}
		}
	}
	cout<<-1;
	return 0;
}