| /* |
| * Copyright (C) 2012 The Android Open Source Project |
| * |
| * Licensed under the Apache License, Version 2.0 (the "License"); |
| * you may not use this file except in compliance with the License. |
| * You may obtain a copy of the License at |
| * |
| * http://www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, software |
| * distributed under the License is distributed on an "AS IS" BASIS, |
| * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| * See the License for the specific language governing permissions and |
| * limitations under the License. |
| */ |
| #define ADK_INTERNAL |
| #include "fwk.h" |
| #include "accel.h" |
| #include "I2C.h" |
| |
| |
| |
| char accelInit(void){ //0 on failure |
| |
| if(i2cScan(1, 0x19) == I2C_ERR_NAK) return 0; //not found |
| |
| i2cSingleWrite(1, 0x19, 0x24, 0x80); |
| i2cSingleWrite(1, 0x19, 0x24, 0x00); |
| |
| i2cSingleWrite(1, 0x19, 0x20, 0x97); // 1.344khz sample rate, no low power, all axes enabled |
| i2cSingleWrite(1, 0x19, 0x23, 0x80); |
| i2cSingleWrite(1, 0x19, 0x24, 0x00); |
| |
| return 1; |
| } |
| |
| |
| void accelRead(int16_t* x, int16_t* y, int16_t* z){ |
| |
| while(!(i2cSingleRead(1, 0x19, 0x27) & 8)); |
| |
| if(x) *x = (int16_t)((uint16_t)i2cSingleRead(1, 0x19, 0x28) | ((uint16_t)i2cSingleRead(1, 0x19, 0x29) << 8)); |
| if(y) *y = (int16_t)((uint16_t)i2cSingleRead(1, 0x19, 0x2A) | ((uint16_t)i2cSingleRead(1, 0x19, 0x2B) << 8)); |
| if(z) *z = (int16_t)((uint16_t)i2cSingleRead(1, 0x19, 0x2C) | ((uint16_t)i2cSingleRead(1, 0x19, 0x2D) << 8)); |
| } |