Спасибо всем большое, кое что накидал, вроде работает...
Если что, обращайтесь, поделюсь исходниками...
Правда не все так красиво, но зато работает и по потокам раскидано...
С удовольствием все пофиксил бы да знаний немного не хватает в С...
Поэтому и прошу помощи...
С меня полное тестирование, ну возможно еще помощь в том, что расковырял...