wip on arduino side, now object oriented way