Fixing wrong command number (arduino firmware)