REM I2C TEST (AM2320 & AQM0802)

I2C 100:REM Set I2C Baudrate 100KHz
DIM D(1)
GOSUB AM2320,D
GOSUB INIAMQ
GOSUB PRTAMQ,0,"¼ÂÄÞ"+DEC$((PEEK(D+2)*256+PEEK(D+3))/10)+"%"
GOSUB PRTAMQ,1,"·µÝ "+DEC$((PEEK(D+4)*256+PEEK(D+5))/10)+"ßC"
END

LABEL AM2320
 REM Get Temperture & Humidity from AM2320
 I2CWRITE $5C,0:REM Wake Up the Device
 I2CWRITE $5C,3,0,4
 I2CREADDATA $5C,ARGS(1),8
RETURN

LABEL INIAMQ
 REM Initialize AMQ0802
 I2CWRITE $3E,$00,$38:WAIT 1
 I2CWRITE $3E,$00,$39:WAIT 1
 I2CWRITE $3E,$00,$14:WAIT 1
 I2CWRITE $3E,$00,$73:WAIT 1
 I2CWRITE $3E,$00,$56:WAIT 1
 I2CWRITE $3E,$00,$6C:WAIT 15
 I2CWRITE $3E,$00,$38:WAIT 1
 I2CWRITE $3E,$00,$01:WAIT 1
 I2CWRITE $3E,$00,$0C:WAIT 1
RETURN

LABEL PRTAMQ
 REM Print String in line n
 VAR S
 I2CWRITE $3E,0,$80+((ARGS(1) AND 1)<<6):WAIT 1
 S=ARGS(2)
 WHILE PEEK(S)
  I2CWRITE $3E,$40,PEEK(S):WAIT 1
  S=S+1
 WEND
RETURN