Remove unused variables
Check CS is registered and configured before sending command
Fixes #19