Developing A Comprehensive Matlab Platform For Robotic Simulation