Improve master algorithm
Improve the algorithm for master module. Implement something similar to MCP4725 master.