Make use of assertions

To increase the quality of the source code and improve the debugability using assertions might be useful. The appropriate header is already part of avr-libc. Refer to [this](http://www.nongnu.org/avr-libc/user-manual/group__avr__assert.html) for details.
