Add My own Voltage Control Algo

Signed-off-by: zeroblade1984 <zeroblade1984@gmail.com>