字节三个特工（Java）

我叫王大锤，是一名特工。我刚刚接到任务：在字节跳动大街进行埋伏，抓捕恐怖分子孔连顺。和我一起行动的还有另外两名特工，我提议

1. 我们在字节跳动大街的N个建筑中选定3个埋伏地点。
2. 为了相互照应，我们决定相距最远的两名特工间的距离不超过D。

我特喵是个天才! 经过精密的计算，我们从X种可行的埋伏方案中选择了一种。这个方案万无一失，颤抖吧，孔连顺！
……
万万没想到，计划还是失败了，孔连顺化妆成小龙女，混在cosplay的队伍中逃出了字节跳动大街。只怪他的伪装太成功了，就是杨过本人来了也发现不了的！

请听题：给定N（可选作为埋伏点的建筑物数）、D（相距最远的两名特工间的距离的最大值）以及可选建筑的坐标，计算在这次行动中，大锤的小队有多少种埋伏选择。
注意：

1. 两个特工不能埋伏在同一地点
2. 三个特工是等价的：即同样的位置组合(A, B, C) 只算一种埋伏方法，不能因“特工之间互换位置”而重复使用

public class ThreeAgents {
    public static void main(String[] args){
        //输入
        Scanner scan = new Scanner(System.in);
        int n = scan.nextInt();
        int d = scan.nextInt();
        int[] addrs = new int[n];
        for(int i = 0;i < n;i++){
            addrs[i] = scan.nextInt();
        }

        //处理
        long result = 0;//结果
        int p = 0;
        //从第三个数开始，遍历数组，
        // 1、如果特工人数够3个，但是间距太远，让第一个特工p++
        // 2、i和p间距保证大于3个特工，否则表示只有两个特工的地方了，王大锤向后移动i++
        // 3、如果满足三个特工，而且间距不超过D，此时求C（2）（i-p）
        // （i-p）中选两个，再加上王大锤位置，必定不会重复
        for(int i = 2;i < n;){//距离超出d之后，第一个人向前移动，王大锤不动，所以i++放到内部处理
            if(addrs[i] - addrs[p] > d){
                p++;
            }else if(i - p < 2){
                i++;
            }else{
                result += (long)(i-p)*(i-p-1)/2;
                i++;
            }
        }
        System.out.println(result % 99997867);//按要求取模
    }
}