Some lil refactoring to save some memory for the 328p
Merge pull request #380 from Kenny9999/development

Some lil refactoring to save some memory for the 328p