Control Lego power function motors and servo with Arduino