Create esoq2p1.m

source matlab code