Hallo !

Schau mal hier:
http://www.rn-wissen.de/index.php/TWI_Praxis
Ist zwar Bascom Code, aber dürfte wohl leicht nach C konvertierbar sen.
Fertige Programme für deinen speziellen Fall wird Dir wohl kaum Jemand hier liefern.

Roland