SW PSoC bugfix

Mindre bug fjernet