Thanks everybody for your tips, I'll just try to refactor my code a bit and port it onto an ATmega328P.
@PaulRB, @INTP: Oops, I mean pinouts with PWM of couse.
