Create the IC algorithm.
Still to test for current to go to float stage.
Add remaining variables to GUI
Yet to add these to firmware.