void Accelerometer_Init() { SPI_Enable(); SPCR = 0x50; AACCS_SS_LOW(); WriteAcc(0x0D,0x80); // Disable I2C WriteAcc(0x16,0x05); // Init 2G AACCS_SS_HIGH(); SPI_Disable(); }
//will only set low register values high; may need to add functionality later to set values to 0 unsigned char ConfigureAcc(unsigned char reg, unsigned char value) { unsigned char current_reg_val = ReadAcc(reg); unsigned char new_val = current_reg_val |= value; WriteAcc(reg, new_val); rprintf("AccConfig: "); rprintf("Reg %x, Val: %x\n\r", reg, ReadAcc(reg)); return new_val; }