mirror of
https://github.com/Telecominfraproject/OpenCellular.git
synced 2026-01-03 13:39:53 +00:00
56385a0567
Enabling of ALS is done during resume hook. During EC sw sync, resume hook is not called and hence ALS task wont run. Adding init hook to wake up the ALS task. BUG=chrome-os-partner:48418 BRANCH=none TEST= On Kunimitsu board, ensure sw sync is enabled. In OS, cat /sys/bus/iio/devices/iio:devicesx/in_illuminace_input should output valid value and not zero. Change-Id: Iba1a3ab2cf7bfc2d8aa36cf9bb9b762f398882c3 Signed-off-by: Jagadish Krishnamoorthy <jagadish.krishnamoorthy@intel.com> Reviewed-on: https://chromium-review.googlesource.com/317030 Commit-Ready: Freddy Paul <freddy.paul@intel.com> Reviewed-by: Freddy Paul <freddy.paul@intel.com> Reviewed-by: Shawn N <shawnn@chromium.org>
124 lines
2.5 KiB
C
124 lines
2.5 KiB
C
/* Copyright (c) 2013 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.
|
|
*/
|
|
|
|
/* This provides the interface for any Ambient Light Sensors that are connected
|
|
* to the EC instead of the AP.
|
|
*/
|
|
|
|
#include "als.h"
|
|
#include "chipset.h"
|
|
#include "common.h"
|
|
#include "console.h"
|
|
#include "hooks.h"
|
|
#include "host_command.h"
|
|
#include "system.h"
|
|
#include "task.h"
|
|
#include "timer.h"
|
|
#include "util.h"
|
|
|
|
#define ALS_POLL_PERIOD SECOND
|
|
|
|
static int task_timeout = -1;
|
|
|
|
int als_read(enum als_id id, int *lux)
|
|
{
|
|
int af = als[id].attenuation_factor;
|
|
return als[id].read(lux, af);
|
|
}
|
|
|
|
void als_task(void)
|
|
{
|
|
int i, val;
|
|
uint16_t *mapped = (uint16_t *)host_get_memmap(EC_MEMMAP_ALS);
|
|
uint16_t als_data;
|
|
|
|
while (1) {
|
|
task_wait_event(task_timeout);
|
|
|
|
/* If task was disabled while waiting do not read from ALS */
|
|
if (task_timeout < 0)
|
|
continue;
|
|
|
|
for (i = 0; i < EC_ALS_ENTRIES && i < ALS_COUNT; i++) {
|
|
als_data = als_read(i, &val) == EC_SUCCESS ? val : 0;
|
|
mapped[i] = als_data;
|
|
}
|
|
}
|
|
}
|
|
|
|
static void als_task_enable(void)
|
|
{
|
|
int fail_count = 0;
|
|
int err;
|
|
int i;
|
|
|
|
for (i = 0; i < EC_ALS_ENTRIES && i < ALS_COUNT; i++) {
|
|
err = als[i].init();
|
|
if (err) {
|
|
fail_count++;
|
|
ccprintf("%s ALS sensor failed to initialize, err=%d\n",
|
|
als[i].name, err);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* If all the ALS filed to initialize, disable the ALS task.
|
|
*/
|
|
if (fail_count == ALS_COUNT)
|
|
task_timeout = -1;
|
|
else
|
|
task_timeout = ALS_POLL_PERIOD;
|
|
|
|
task_wake(TASK_ID_ALS);
|
|
}
|
|
|
|
static void als_task_disable(void)
|
|
{
|
|
task_timeout = -1;
|
|
}
|
|
|
|
static void als_task_init(void)
|
|
{
|
|
/*
|
|
* Enable ALS task in S0 only and may need to re-enable
|
|
* when sysjumped.
|
|
*/
|
|
if (system_jumped_to_this_image() &&
|
|
chipset_in_state(CHIPSET_STATE_ON))
|
|
als_task_enable();
|
|
}
|
|
|
|
DECLARE_HOOK(HOOK_CHIPSET_RESUME, als_task_enable, HOOK_PRIO_ALS_INIT);
|
|
DECLARE_HOOK(HOOK_CHIPSET_SUSPEND, als_task_disable, HOOK_PRIO_DEFAULT);
|
|
DECLARE_HOOK(HOOK_INIT, als_task_init, HOOK_PRIO_ALS_INIT);
|
|
|
|
/*****************************************************************************/
|
|
/* Console commands */
|
|
|
|
#ifdef CONFIG_CMD_ALS
|
|
static int command_als(int argc, char **argv)
|
|
{
|
|
int i, rv, val;
|
|
|
|
for (i = 0; i < ALS_COUNT; i++) {
|
|
ccprintf("%s: ", als[i].name);
|
|
rv = als_read(i, &val);
|
|
switch (rv) {
|
|
case EC_SUCCESS:
|
|
ccprintf("%d lux\n", val);
|
|
break;
|
|
default:
|
|
ccprintf("Error %d\n", rv);
|
|
}
|
|
}
|
|
|
|
return EC_SUCCESS;
|
|
}
|
|
DECLARE_CONSOLE_COMMAND(als, command_als,
|
|
NULL,
|
|
"Print ALS values",
|
|
NULL);
|
|
#endif
|