青蛙 C++

描述
青蛙Filip住在一条数轴上。这条数轴上有N个岛屿，岛屿的坐标已知。
一开始，Filip在坐标为position[0]的岛屿上。他的最大跳跃距离为L，这意味着他可以跳往任何一个与他的距离不超过L的岛屿。Filip不能跳到一个没有岛屿的点上。他的跳跃次数没有限制。
当Filip可以通过若干次跳跃最终到达某个岛屿，那么我们称这个岛屿是可达的。请你求出有多少个岛屿是可达的。

输入格式
多组测试数据。第一行为测试数据组数。
对每组测试数据，第一行为两个整数N, L，第二行有N个整数，为position[]。

输出格式
对每组测试数据输出一行表示答案。

输入/输出例子1
输入：

4

5 1

4 7 1 3 5

5 2

100 101 103 105 107

8 4

17 10 22 14 6 1 2 3

1 1000

0

输出：

3

5

7

1

【数据范围】

岛屿的个数不超过500。 岛屿的坐标是不超过1000的非负整数，且两两不同。 1≤L≤1000。1<=T<=10

上代码：

#include<bits/stdc++.h>
using namespace std;
int T,n,l,p[10001],ans,an,k,kk;
int main()
{
    cin>>T;
    while(T--)
   	{
   		cin>>n>>l;
   		for(int i=1;i<=n;i++)
   			cin>>p[i];
   		ans=p[1],an=ans,kk=1;
   		sort(p+1,p+n+1);
   		for(int i=1;i<=n;i++)
   			if(p[i]==ans) {k=i;break;}
   		for(int i=k-1;i>=1;i--)
   			if(ans-p[i]>l) {break;}
   				else ans=p[i],kk++;
		for(int i=k+1;i<=n;i++)
   			if(p[i]-an>l) {break;}
   				else an=p[i],kk++; 		
		cout<<kk<<endl;
	} 
    
    return 0;
}