talksik
51 lines
1.2 KiB
C++
51 lines
1.2 KiB
C++
#include <Arduino.h>
|
|
#include <Wire.h>
|
|
#include "PAJ7620U2.h"
|
|
|
|
|
|
|
|
uint8_t I2C_readByte(uint8_t addr)
|
|
{
|
|
Wire.beginTransmission(PAJ7620U2_I2C_ADDRESS);
|
|
Wire.write(addr);
|
|
Wire.endTransmission();
|
|
Wire.requestFrom(PAJ7620U2_I2C_ADDRESS, 1);
|
|
if (Wire.available()) {
|
|
return Wire.read();
|
|
}
|
|
return 0;
|
|
}
|
|
uint16_t I2C_readU16(uint8_t addr)
|
|
{
|
|
uint16_t x; uint16_t t;
|
|
|
|
Wire.beginTransmission(PAJ7620U2_I2C_ADDRESS);
|
|
Wire.write(addr);
|
|
Wire.endTransmission();
|
|
Wire.requestFrom(PAJ7620U2_I2C_ADDRESS, 2);
|
|
t = Wire.read();
|
|
x = Wire.read();
|
|
x <<= 8;
|
|
x |= t;
|
|
return x;
|
|
}
|
|
void I2C_writeByte(uint8_t addr, uint8_t data)
|
|
{
|
|
Wire.beginTransmission(PAJ7620U2_I2C_ADDRESS);
|
|
Wire.write(addr);
|
|
Wire.write(data & 0xFF);
|
|
Wire.endTransmission();
|
|
}
|
|
uint8_t PAJ7620U2_init()
|
|
{
|
|
uint8_t i,State;
|
|
State =I2C_readByte(0x00); //Read State
|
|
if (State != 0x20) return 0; //Wake up failed
|
|
I2C_writeByte(PAJ_BANK_SELECT, 0); //Select Bank 0
|
|
for (i=0;i< Init_Array;i++)
|
|
{
|
|
I2C_writeByte(Init_Register_Array[i][0], Init_Register_Array[i][1]);//Power up initialize
|
|
}
|
|
return 1;
|
|
}
|