updated readme, CPP, h files
fixed SetCS problem