求助大佬优化代码

#include<bits/stdc++.h>
using namespace std;
long long N,C,x;
int a[20001];
int find1(int C)
{
int l=0,r=N+1,i;				
    while(l+1<r)			
    {			
        i=(l+r)/2;		
        if(a[i]<=C)l=i;
        else r=i;		
    }			
    return l;			
}
int find2(int C)
{
int l=0,r=N+1,i;				
    while(l+1<r)			
    {			
        i=(l+r)/2;		
        if(a[i]<C)l=i;		
        else r=i;		
    }			
    return l;			
}
int main()
{
cin>>N>>C;
for(int i=1; i<=N; i++)
{
    cin>>a[i];
}
sort(a+1,a+1+N);

for(int i=1; i<=N; i++)
{
    x+=find1(a[i]+C)-find2(a[i]+C);
}
cout<<x;
return 0;
}