C++小朋友排队（树状数组）

n个小朋友站成一排。现在要把他们按身高从低到高的顺序排列，但是每次只能交换位置相邻的两个小朋友。每个小朋友都有一个不高兴的程度。开始的时候，所有小朋友的不高兴程度都是 0。如果某个小朋友第一次被要求交换，则他的不高兴程度增加 1，如果第二次要求他交换，则他的不高兴程度增加 2（即不高兴程度为 3），依次类推。当要求某个小朋友第 k 次交换时，他的不高兴程度增加 k。请问，要让所有小朋友按从低到高排队，他们的不高兴程度之和最小是多少。如果有两个小朋友身高一样，则他们谁站在谁前面是没有关系的。
输入格式
输入的第一行包含一个整数 n，表示小朋友的个数。
第二行包含 n个整数 H1,H2,…,Hn，分别表示每个小朋友的身高。
输出格式
输出一行，包含一个整数，表示小朋友的不高兴程度和的最小值。
数据范围
1≤n≤100000,0≤Hi≤1000000
输入样例：
3
3 2 1
输出样例：
9
样例解释
首先交换身高为3和2的小朋友，再交换身高为3和1的小朋友，再交换身高为2和1的小朋友，每个小朋友的不高兴程度都是3，总和为9。

AC代码：

#include<stdio.h>
#include<string.h>

const int H=1000010;
const int N=100010;

int data[N],tr[H];
int sum[N];
long long ans;

int lowbit(int x)
{
    return x & (-x);
}

void add(int x)
{
    for(int i=x;i<H;i+=lowbit(i)) ++tr[i];
}

int query(int x)
{
    int sum=0;
    for(int i=x;i>0;i-=lowbit(i)) sum+=tr[i];
    return sum;
}

int main()
{
    int n;
    scanf("%d",&n);
    for(int i=0;i<n;++i) scanf("%d",&data[i]);
	//寻找每个小朋友前面比他高的小朋友人数
    for(int i=0;i<n;++i)
    {
        sum[i]+=query(H-1)-query(data[i]);
        add(data[i]);
    }
	//寻找每个小朋友后面比他矮的小朋友人数
    memset(tr,0,sizeof(tr));
    for(int i=n-1;i>=0;--i)
    {
        sum[i]+=query(data[i]-1);
        add(data[i]);
    }

    for(int i=0;i<n;++i) ans+=(long long)sum[i]*(sum[i]+1)/2;
    printf("%lld",ans);

    return 0;
}