Matlab-based Robotics Pathing Script