import gpio
import i2c

bus := i2c.Bus
  --sda=gpio.Pin 16
  --scl=gpio.Pin 26
  --frequency=80_000

device := bus.device 0x57

a0 := gpio.Pin 14 --output
motion := gpio.Pin 27 --input
// clock := gpio.Pin 26 --output
// iodev := gpio.Pin 16 --output
shutdown := gpio.Pin 17 --output
nrst := gpio.Pin 22 --output
vddio := gpio.Pin 21 --output


//For TWI:
// 1. Apply power. Refer timing diagram on power up
// sequence below.
// 2. Set SHTDWN and IO_SELECT pin low.
// 3. Set A0 and A1 according to the desired TWI slave
// address (from TWI slave address table in datasheet).
// 4. Drive NRST pin low then high. TWI slave address will
// only be valid and according to the address set in step
// 3 after a NRST toggle is applied.
// 5. Read Product ID (PID) to ensure sensor is powered up
// and communicating properly with host.
// 6. Write 0xE4 to address 0x60
// 7. Write 0xC9 to address 0x61

main:
  shutdown.set 0
  a0.set 1
  vddio.set 1

  // Drive NRST low, then high 
  nrst.set 0 // Do this last to turn on the chip?
  sleep --ms=80
  nrst.set 1

  sleep --ms=10

  // 6. Write 0xE4 to address 0x60
  // 7. Write 0xC9 to address 0x61
  // Read Product ID (PID) to ensure sensor is powered up
  // and communicating properly with host.

  device.write-reg 0x60 #[0xE4]
  device.write-reg 0x61 #[0xC9]

  value2 := device.read-reg 0 1
  print value2
  sleep --ms=50
 
  value := device.read-reg 0x3f 1
  print value
  sleep --ms=10

  sleep --ms=2000
  print "Done"
  device.close

a0

vddio.set 1