Mach doch mal nen Anfang, entweder in pseudocode oder gleich in C.