MATLAB Point-Mass Lap Sim