Static inline all functions except ISR

Program Memory Usage  : 3240 bytes
Revert "Static inline all functions except ISR"

This reverts commit 549d8dcbc6514339c0be5555d5d4cfc100de8cf0.
Revert "Revert "Static inline all functions except ISR""

This reverts commit 0f11d62e9d265a81533cfd1abd182e5fab547871.