[avr-gcc]7x7 RGB matrix code problem

Hallo liebes forum , da sich meine festplatte verabschiedet hat muss ich 
nun für mein selbstgemachtes 7x7rgb display den code neu schreiben,
ich bin etwas aus der übung.

es handelt sich um Bit angle modulation im multiplex betrieb
das ganze läuft mit einem atmega32 auf 24,5Mhz übertaktet

bei der multiplex.S ist der code für den output compare match B nur als 
erweiterung für mehr bits gedacht und somit erstmal nicht zu 
berücksichtigen da ich einmal es mit nur 8bit farbauflösung probieren 
will.

code ist angehängt und foto von der aktuellen ausgabe am display