洛谷 P1135 奇怪的电梯

P1135 奇怪的电梯
题目描述
呵呵，有一天我做了一个梦，梦见了一种很奇怪的电梯。大楼的每一层楼都可以停电梯，而且第iii层楼(1≤i≤N)(1 \le i \le N)(1≤i≤N)上有一个数字Ki(0≤Ki≤N)K_i(0 \le K_i \le N)Ki​(0≤Ki​≤N)。电梯只有四个按钮：开，关，上，下。上下的层数等于当前楼层上的那个数字。当然，如果不能满足要求，相应的按钮就会失灵。例如：3,3,1,2,53, 3 ,1 ,2 ,53,3,1,2,5代表了Ki(K1=3,K2=3,…)K_i(K_1=3,K_2=3,…)Ki​(K1​=3,K2​=3,…)，从111楼开始。在111楼，按“上”可以到444楼，按“下”是不起作用的，因为没有−2-2−2楼。那么，从AAA楼到BBB楼至少要按几次按钮呢？
输入格式
共二行。第一行为333个用空格隔开的正整数，表示N,A,B(1≤N≤200,1≤A,B≤N)N,A,B(1≤N≤200, 1≤A,B≤N)N,A,B(1≤N≤200,1≤A,B≤N)。
第二行为N个用空格隔开的非负整数，表示KiK_iKi​。
输出格式
一行，即最少按键次数,若无法到达，则输出−1。
输入样例
5 1 5
3 3 1 2 5
输出样例
8
我的理解：这题我用的广搜，但是由于做的时候犯了很多神奇的错误，就错了几次。。
AC代码：

#include<bits/stdc++.h>
using namespace std;
int ans[200 + 10];
int vis[200 + 10];//记录该层是否被访问到 
int f[200+10];//记录步数 
int n,a,b,i