mirror of
https://github.com/Telecominfraproject/OpenCellular.git
synced 2026-01-10 01:21:49 +00:00
a9a9ae1abc
Move structure used by lms6ds0 to motion_sense.h, so that bosh driver can use the same mechanism. Use code to avoid reading chip range when reading data. BUG=none BRANCH=none TEST=Check Bosh driver is working as expected. Change-Id: Id8b5bb8735e479a122ef32ab9a400fba189d7488 Signed-off-by: Gwendal Grignou <gwendal@chromium.org> Reviewed-on: https://chromium-review.googlesource.com/270453 Reviewed-by: Vincent Palatin <vpalatin@chromium.org>
109 lines
2.8 KiB
C
109 lines
2.8 KiB
C
/* Copyright (c) 2014 The Chromium OS Authors. All rights reserved.
|
|
* Use of this source code is governed by a BSD-style license that can be
|
|
* found in the LICENSE file.
|
|
*/
|
|
/* ryu sensor hub configuration */
|
|
|
|
#include "clock.h"
|
|
#include "common.h"
|
|
#include "console.h"
|
|
#include "driver/accelgyro_lsm6ds0.h"
|
|
#include "gpio.h"
|
|
#include "hooks.h"
|
|
#include "i2c.h"
|
|
#include "motion_sense.h"
|
|
#include "power.h"
|
|
#include "registers.h"
|
|
#include "task.h"
|
|
#include "util.h"
|
|
|
|
#include "gpio_list.h"
|
|
|
|
/* power signal list. Must match order of enum power_signal. */
|
|
const struct power_signal_info power_signal_list[] = {
|
|
{GPIO_AP_IN_SUSPEND, 1, "SUSPEND_ASSERTED"},
|
|
};
|
|
BUILD_ASSERT(ARRAY_SIZE(power_signal_list) == POWER_SIGNAL_COUNT);
|
|
|
|
/* I2C ports */
|
|
const struct i2c_port_t i2c_ports[] = {
|
|
{"master", I2C_PORT_MASTER, 100,
|
|
GPIO_MASTER_I2C_SCL, GPIO_MASTER_I2C_SDA},
|
|
{"slave", I2C_PORT_SLAVE, 100,
|
|
GPIO_SLAVE_I2C_SCL, GPIO_SLAVE_I2C_SDA},
|
|
};
|
|
const unsigned int i2c_ports_used = ARRAY_SIZE(i2c_ports);
|
|
|
|
/* Sensor mutex */
|
|
static struct mutex g_mutex;
|
|
|
|
/* local sensor data (per-sensor) */
|
|
struct motion_data_t g_saved_data[2];
|
|
|
|
struct motion_sensor_t motion_sensors[] = {
|
|
|
|
/*
|
|
* Note: lsm6ds0: supports accelerometer and gyro sensor
|
|
* Requirement: accelerometer sensor must init before gyro sensor
|
|
* DO NOT change the order of the following table.
|
|
*/
|
|
{.name = "Accel",
|
|
.active_mask = SENSOR_ACTIVE_S0_S3,
|
|
.chip = MOTIONSENSE_CHIP_LSM6DS0,
|
|
.type = MOTIONSENSE_TYPE_ACCEL,
|
|
.location = MOTIONSENSE_LOC_LID,
|
|
.drv = &lsm6ds0_drv,
|
|
.mutex = &g_mutex,
|
|
.drv_data = &g_saved_data[0],
|
|
.i2c_addr = LSM6DS0_ADDR1,
|
|
.rot_standard_ref = NULL,
|
|
.default_config = {
|
|
.odr = 119000,
|
|
.range = 2
|
|
}
|
|
},
|
|
|
|
{.name = "Gyro",
|
|
.active_mask = SENSOR_ACTIVE_S0_S3,
|
|
.chip = MOTIONSENSE_CHIP_LSM6DS0,
|
|
.type = MOTIONSENSE_TYPE_GYRO,
|
|
.location = MOTIONSENSE_LOC_LID,
|
|
.drv = &lsm6ds0_drv,
|
|
.mutex = &g_mutex,
|
|
.drv_data = &g_saved_data[1],
|
|
.i2c_addr = LSM6DS0_ADDR1,
|
|
.rot_standard_ref = NULL,
|
|
.default_config = {
|
|
.odr = 119000,
|
|
.range = 2000
|
|
}
|
|
},
|
|
|
|
};
|
|
const unsigned int motion_sensor_count = ARRAY_SIZE(motion_sensors);
|
|
|
|
/*
|
|
* Note: If a new sensor driver is added, make sure to update the following
|
|
* assert.
|
|
*/
|
|
BUILD_ASSERT(ARRAY_SIZE(motion_sensors) == ARRAY_SIZE(g_saved_data));
|
|
|
|
void board_config_pre_init(void)
|
|
{
|
|
/*
|
|
* enable SYSCFG clock:
|
|
* otherwise the SYSCFG peripheral is not clocked during the pre-init
|
|
* and the register write as no effect.
|
|
*/
|
|
STM32_RCC_APB2ENR |= 1 << 0;
|
|
/* Delay 1 APB clock cycle after the clock is enabled */
|
|
clock_wait_bus_cycles(BUS_APB, 1);
|
|
/*
|
|
* Remap USART DMA to match the USART driver
|
|
* the DMA mapping is :
|
|
* Chan 4 : USART1_TX
|
|
* Chan 5 : USART1_RX
|
|
*/
|
|
STM32_SYSCFG_CFGR1 |= (1 << 9) | (1 << 10);/* Remap USART1 RX/TX DMA */
|
|
}
|