add to const current mode

const voltage mode is good, but constant current needs tweaking.