Add PSoC 5 code