refactor current control to save memory

M500 now saves all currents for all configured channels