power_spi.c: Rewrite pmic_reg function