Starting Efforts

Program Memory Usage  : 3254 bytes
Changed everything except ISR to static inline.

Program Memory Usage  : 3240 bytes