Connect to camera // Get device node map // Turn on VoltageExternalEnable (GPIO VDD) Set LineSelector = Line4 VoltageTageExternalEnable = True I2CSlaveAddress = 0圆8 I2CSCLSource = Line2 I2CSDASource = Line3 I2CAccessLength = 1 // Write 1 byte at a time // Set I2C Write Operation I2COperationSelector = Write // Write 0x01 to SELF_TEST_X_ACCEL I2CRegisterAddress = 0x0D I2CAccessBuffer = 0x01 I2COperationExecute() // Confirm I2COperationStatus = Success // Write 0x01 to SELF_TEST_Y_ACCEL I2CRegisterAddress = 0x0E I2CAccessBuffer = 0x01 I2COperationExecute() // Confirm I2COperationStatus = Success // Write 0x01 to SELF_TEST_Z_ACCEL I2CRegisterAddress = 0x0F I2CAccessBuffer = 0x01 I2COperationExecute() // Confirm I2COperationStatus = Success // Read SELF_TEST_X_ACCEL I2CRegisterAddress = 0x0D I2COperationExecute() // Confirm I2COperationStatus = Success SELF_TEST_X_ACCEL = I2CAccessBuffer // Read 1 byte out of I2CAccessBuffer // Read SELF_TEST_Y_ACCEL I2CRegisterAddress = 0x0D I2COperationExecute() // Confirm I2COperationStatus = Success SELF_TEST_Y_ACCEL = I2CAccessBuffer // Read 1 byte out of I2CAccessBuffer // Read SELF_TEST_Z_ACCEL I2CRegisterAddress = 0x0D I2COperationExecute() // Confirm I2COperationStatus = Success SELF_TEST_Z_ACCEL = I2CAccessBuffer // Read 1 byte out of I2CAccessBuffer Connect to camera // Get device node map // Turn on VoltageExternalEnable (GPIO VDD) Set LineSelector = Line4 VoltageTageExternalEnable = True I2CSlaveAddress = 0圆8 I2CSCLSource = Line2 I2CSDASource = Line3 I2CAccessLength = 1 // Read 1 byte at a time // Set I2C Read Operation I2COperationSelector = Read // Read ACCEL_XOUT_HIGH I2CRegisterAddress = 0x3B I2COperationExecute() // Confirm I2COperationStatus = Success ACCEL_XOUT_HIGH = I2CAccessBuffer // Read 1 byte out of I2CAccessBuffer // Read ACCEL_XOUT_LOW I2CRegisterAddress = 0x3C I2COperationExecute() // Confirm I2COperationStatus = Success ACCEL_XOUT_LOW = I2CAccessBuffer // Read 1 byte out of I2CAccessBuffer // Read ACCEL_YOUT_HIGH I2CRegisterAddress = 0x3D I2COperationExecute() // Confirm I2COperationStatus = Success ACCEL_YOUT_HIGH = I2CAccessBuffer // Read 1 byte out of I2CAccessBuffer // Read ACCEL_YOUT_LOW I2CRegisterAddress = 0x3E I2COperationExecute() // Confirm I2COperationStatus = Success ACCEL_YOUT_LOW = I2CAccessBuffer // Read 1 byte out of I2CAccessBuffer // Read ACCEL_ZOUT_HIGH I2CRegisterAddress = 0x3F I2COperationExecute() // Confirm I2COperationStatus = Success ACCEL_ZOUT_HIGH = I2CAccessBuffer // Read 1 byte out of I2CAccessBuffer // Read ACCEL_ZOUT_LOW I2CRegisterAddress = 0x40 I2COperationExecute() // Confirm I2COperationStatus = Success ACCEL_ZOUT_LOW = I2CAccessBuffer // Read 1 byte out of I2CAccessBuffer
0 kommentar(er)
