fixed two obvious errors in CSP code
Merge pull request #31 from ArduSat/csp_fixes

error fixes in CSP code