蛇和梯子游戏（BFS）

《图论算法理论、实现及应用》中例2.5 蛇和梯子游戏（Snakes & Ladders）

题意：如大富翁掷骰子走方格游戏原理，棋盘是n*n矩阵，从（1,1）开始，掷骰子，落脚点在蛇头，则降至蛇尾处，落脚点在梯子尾则直接到梯子头部，先达到n*n处获胜。

没有测试平台，我的代码对不对不清楚

#include<stdio.h>
#include<string.h>
#include<stdlib.h>
#include<queue>
#include<algorithm>
using namespace std;
int a[450];
int vis[450];
int du[450];
int i,nn;          
void bfs(int aa){
	int k,sum,j,ii;
	queue<int>q;
	q.push(aa);
	vis[1]=1;
	du[k]=0;
	while(!q.empty()){
		k=q.front(); q.pop();
		if(vis[nn]){
			printf("%d\n",du[nn]);
			return ;
		} 
		for(j=1;j<=6;j++){
			ii=k+j;
			if(vis[ii]==0){
				if(a[ii]){
					q.push(a[ii]);
					vis[a[ii]]=1;
					du[a[ii]]=du[k]+1;
				}
				else{
					q.push(ii);
				} 
				vis[ii]=1;
				du[ii]=du[k]+1;
			}
			if(vis[nn]){
				printf("%d\n",du[nn]);
				return ;
			} 
		}
	}
}
int main(){
	int t,n,s,l,c,d;
	scanf("%d",&t);
	while(t--){
		memset(vis,0,sizeof(vis));
		memset(a,0,sizeof(a));
		memset(du,0,sizeof(du));
		scanf("%d%d%d",&n,&s,&l);
		for(i=0;i<s+l;i++){
			scanf("%d %d",&c,&d);
			a[c]=d;
		}
		nn=n*n;
		bfs(1);
	}
	return 0;
}

/*
2
6 1 3
35 25
3 23 5 16 20 33
*/