Using Simulink for Control Algorithms with LEGO