diff options
Diffstat (limited to 'zephyr/projects/nissa/pujjo/src/form_factor.c')
-rw-r--r-- | zephyr/projects/nissa/pujjo/src/form_factor.c | 22 |
1 files changed, 22 insertions, 0 deletions
diff --git a/zephyr/projects/nissa/pujjo/src/form_factor.c b/zephyr/projects/nissa/pujjo/src/form_factor.c index ff3d64fe3e..3edc7f7aa3 100644 --- a/zephyr/projects/nissa/pujjo/src/form_factor.c +++ b/zephyr/projects/nissa/pujjo/src/form_factor.c @@ -11,8 +11,11 @@ #include "cros_cbi.h" #include "driver/accelgyro_bmi323.h" #include "driver/accelgyro_lsm6dsm.h" +#include "gpio/gpio_int.h" #include "hooks.h" #include "motionsense_sensors.h" +#include "motion_sense.h" +#include "tablet_mode.h" #include "nissa_common.h" @@ -30,10 +33,29 @@ void motion_interrupt(enum gpio_signal signal) static void sensor_init(void) { + int ret; + uint32_t val; /* check which base sensor is used for motion_interrupt */ use_alt_sensor = cros_cbi_ssfc_check_match( CBI_SSFC_VALUE_ID(DT_NODELABEL(base_sensor_1))); motion_sensors_check_ssfc(); + + /* Check if it's tablet or not */ + ret = cros_cbi_get_fw_config(FW_TABLET, &val); + if (ret != 0) { + LOG_ERR("Error retrieving CBI FW_CONFIG field %d", FW_TABLET); + return; + } + if (val == FW_TABLET_NOT_PRESENT) { + LOG_INF("Clamshell: disable motionsense function."); + motion_sensor_count = 0; + gmr_tablet_switch_disable(); + gpio_disable_dt_interrupt(GPIO_INT_FROM_NODELABEL(int_imu)); + gpio_pin_configure_dt(GPIO_DT_FROM_NODELABEL(gpio_imu_int_l), + GPIO_DISCONNECTED); + } else { + LOG_INF("Tablet: Enable motionsense function."); + } } DECLARE_HOOK(HOOK_INIT, sensor_init, HOOK_PRIO_POST_I2C); |