import time

#reset and initialize sensor from DES using 953

# Set up IDs
UB954 = 0x7A
UB953ID = 0x30
UB953 = 0x18
sensorID = 0x60
sensorAlias = 0xC4

# Set up Port0
board.WriteI2C(UB954, 0x4C, 0x01)

# Set up Back Channel Config (0x58)
board.WriteI2C(UB954,0x58,0x5E)

# Set up SER ID
#board.WriteI2C(UB954,0x5B,UB953ID)
# Set up SER Alias ID
board.WriteI2C(UB954,0x5C,UB953)
# Set up Slave/Camera ID
board.WriteI2C(UB954,0x5D,sensorID)
# Set up Slave/Camera Alias ID
board.WriteI2C(UB954,0x65,sensorAlias)

# Set GPIO2 and GPIO3 to outputs, where GPIO2 = RESET and GPIO3 = PWDN
board.WriteI2C(UB953,0x0E,0xC0)
# Set GPIO2 and GPIO3 to High - bring sensor out of power down mode
board.WriteI2C(UB953,0x0D,0x0C)
time.sleep(0.1)
# Bring GPIO3 low to place sensor in reset
board.WriteI2C(UB953,0x0D,0x08)
time.sleep(1)
# Bring GPIO3 high again to prepare sensor for initialization
board.WriteI2C(UB953,0x0D,0x0C)
print "Sensor Reset"

#Initialize sensor
board.WriteI2C(sensorAlias,_____,______)
time.sleep(0.1)