CSPsm initial version

Simply an initial version of the CSPsim made on Matlab