Schau mal diese Routinen an: http://www.mikrocontroller.net/topic/6492

Wen man sie verstanden hat, sind sie wirklich easy und funktionieren wunderbar