udp包排序算法，求优化

由于UDP数据包是无序的，在开发过程中一般要作用排序处理，因此本人设计了以下算法来进行排序：
1.开若干个数据接收线程A，若干个数据预处理线程B，若干个数据处理线程C。
2.数据包包头设计有序列号，并用map<int,int> mapX来保存某个套接字当前要处理的序列号，其中key是套接字，value是当前要处理的序列号。
3.A接收到数据后，把数据放入预处理队列m，并唤醒B进行处理。
4.B解析数据包包头，取得包的序列号x。
5.如果x=1，或x与mapX中的序列号一致，则把数据包转移到数据处理队列n，并唤醒C进行处理；否则不处理，跳过以下6~8步骤。
6.设置x=x+1，并保存到mapX。
7.查找m中是否有序列号与x相等的数据包，如果有，则把数据包转移到n，并唤醒C进行处理。
8.循环步骤6~7，直至找不到相对应的序列号为止。

目前觉得步骤6~8效率比较低，看看大家有没有更好的算法。

重要的是，可以实现