小朋友排队 Java

问题描述
　　n 个小朋友站成一排。现在要把他们按身高从低到高的顺序排列，但是每次只能交换位置相邻的两个小朋友。

每个小朋友都有一个不高兴的程度。开始的时候，所有小朋友的不高兴程度都是0。

如果某个小朋友第一次被要求交换，则他的不高兴程度增加1，如果第二次要求他交换，则他的不高兴程度增加2（即不高兴程度为3），依次类推。当要求某个小朋友第k次交换时，他的不高兴程度增加k。

请问，要让所有小朋友按从低到高排队，他们的不高兴程度之和最小是多少。

如果有两个小朋友身高一样，则他们谁站在谁前面是没有关系的。
　　
输入格式
　　输入的第一行包含一个整数n，表示小朋友的个数。
　　第二行包含 n 个整数 H1 H2 … Hn，分别表示每个小朋友的身高。
输出格式
　　输出一行，包含一个整数，表示小朋友的不高兴程度和的最小值。
样例输入
3
3 2 1
样例输出
9
样例说明
　　首先交换身高为3和2的小朋友，再交换身高为3和1的小朋友，再交换身高为2和1的小朋友，每个小朋友的不高兴程度都是3，总和为9。
数据规模和约定
　　对于10%的数据， 1<=n<=10；
　　对于30%的数据， 1<=n<=1000；
　　对于50%的数据， 1<=n<=10000；
　　对于100%的数据，1<=n<=100000，0<=Hi<=1000000。

我的思路：先找到个子最低的小朋友，然后把这个小朋友依次往前排，然后再找到第二低的小朋友，再往前排。然而测试证明这个思路不对……
代码：

import java.util.Scanner;

public class 小朋友排队 {

	public static void main(String[] args) {
		// 输入小朋友人数和身高
		Scanner sc = new Scanner(System.in);
		int n = sc.nextInt();
		int[] nums = new int[n];
		for (int i = 0; i < n; i++) {
			nums[i] = sc.nextInt();
		}

		long[] count = new long[n + 1];
		int temp = nums[1];

		int[] tmp = new int[2];
		for (int k = 0; k < n; k++) {
			tmp[0] = 9999999;
			for (int m = k; m < n; m++) {
				if (tmp[0] >= nums[m]) {
					tmp[0] = nums[m];
					tmp[1] = m;
				}
			}
			if (tmp[0] == nums[k])
				k++;
			// System.out.println("最小值下标： "+tmp[1]+" 值是："+tmp[0]+" 现在下标初始值 k =
			// "+k);
			for (int l = tmp[1]; l > k; l--) {
				// if (nums[l - 1] <= nums[l])
				// break;
				temp = nums[l - 1];
				nums[l - 1] = nums[l];
				nums[l] = temp;
				count[nums[l]] = count[nums[l]] * 2 + 1;
				count[nums[l - 1]] = count[nums[l - 1]] * 2 + 1;
			}
			// for (int i : nums) {
			// System.out.print(i + " ");
			// }
			// System.out.println();
		}
		long sum = 0;
		for (long l : count) {
			sum += l;
			// System.out.println(l);
		}
		// for (int i : nums) {
		// System.out.print(i + " ");
		// }
		System.out.println(sum);
		sc.close();

	}

}