[zhilik]

Я в своё время нечто подобное писал - остались кусочки (там алгоритм Гаусса и ещё чуть-чуть). Если надо - пиши на мыло.