Polynomial trajectory matlab example