洛谷P1135 奇怪的电梯

题目描述:
呵呵，有一天我做了一个梦，梦见了一种很奇怪的电梯。大楼的每一层楼都可以停电梯，而且第i层楼(1≤i≤N)上有一个数字Ki(0≤Ki≤N)。电梯只有四个按钮：开，关，上，下。上下的层数等于当前楼层上的那个数字。当然，如果不能满足要求，相应的按钮就会失灵。例如：3,3,1,2,5代表了Ki(K1=3,K2=3,…)，从1楼开始。在1楼，按“上”可以到4楼，按“下”是不起作用的，因为没有−2楼。那么，从A楼到B楼至少要按几次按钮呢？
输入格式:
共二行。
第一行为3个用空格隔开的正整数，表示N,A,B(1≤N≤200,1≤A,B≤N)。
第二行为N个用空格隔开的非负整数，表示Ki​。
输出格式:
一行，即最少按键次数,若无法到达，则输出−1。
输入输出样例:
输入 #1
5 1 5
3 3 1 2 5
输出#1
3
说明/提示
对于100%的数据，1≤N≤200,1≤A,B≤N,0≤Ki,≤N
代码:
#include<bits/stdc++.h>
using namespace std;
const int maxn = 220;
int ans[maxn],k[maxn],now,dep;
int main(){
int a,b,n;
cin >> n >> a >> b;
for(int i = 1;i <= n;i++){
cin >> k[i];
}
memset(ans,-1,sizeof(ans));//初始化全为-1
queue q;
q.push(a);
ans[a] = 0;//第一步为0
while(!q.empty()){
now = q.front();
q.pop();
dep = now - k[now];
if(dep >= 1 && dep <= n && ans[dep] == -1){
ans[dep] = ans[now] + 1;
q.push(dep);//如果没越界，把他放进队列
}
dep = now + k[now];
if(dep >= 1 && dep <= n && ans[dep] == -1){
ans[dep] = ans[now] + 1;
q.push(dep);//如果没越界，把他放进队列
}
}
cout << ans[b];//输出
}