Self Balancing Robot in MATLAB/Simulink/Simscape