Added two commands to set SW3A & SW3B voltages.

Conflicts:
	board/freescale/mx6q_sabresd/mx6q_sabresd.c
More descriptive error messages
Removed extra write to Access Extended Reg 1
Added OTP Fuse POR command
Cleaned up error messages
Added command to restart pmic -- commented out, waiting for test result.
Removed unnecessary VGEN5 voltage commands
Added write failure expectation to MockIO
Added PMIC function
Simplified PMIC code