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;
}
