+ Pump Control has a working algorithm

Signed-off-by: Imkerix <Imkerix@live.de>