mirror of
https://github.com/Telecominfraproject/OpenCellular.git
synced 2026-01-09 17:11:42 +00:00
f4e772708b
This covers modules which need to initialize before task_start(), but don't particularly care in what order they're initialized. Signed-off-by: Randall Spangler <rspangler@chromium.org> BUG=none TEST=if it boots, it works Change-Id: I69829aac8d1c3c14ee04916a794b84bbf03a09eb
70 lines
1.7 KiB
C
70 lines
1.7 KiB
C
/* Copyright (c) 2012 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.
|
|
*/
|
|
|
|
/* System hooks for Chrome EC */
|
|
|
|
#include "hooks.h"
|
|
#include "uart.h"
|
|
#include "util.h"
|
|
|
|
/* Hooks are described in special sections */
|
|
extern const struct hook_data __hooks_init[];
|
|
extern const struct hook_data __hooks_init_end[];
|
|
extern const struct hook_data __hooks_freq_change[];
|
|
extern const struct hook_data __hooks_freq_change_end[];
|
|
|
|
|
|
int hook_notify(enum hook_type type, int stop_on_error)
|
|
{
|
|
const struct hook_data *start, *end, *p;
|
|
int count, called = 0;
|
|
int last_prio = HOOK_PRIO_FIRST - 1, prio;
|
|
int rv_error = EC_SUCCESS, rv;
|
|
|
|
/* Get the start and end pointers for the hook type */
|
|
switch (type) {
|
|
case HOOK_INIT:
|
|
start = __hooks_init;
|
|
end = __hooks_init_end;
|
|
break;
|
|
case HOOK_FREQ_CHANGE:
|
|
start = __hooks_freq_change;
|
|
end = __hooks_freq_change_end;
|
|
break;
|
|
default:
|
|
/* Unhandled hook type */
|
|
return EC_ERROR_UNKNOWN;
|
|
}
|
|
|
|
count = ((uint32_t)end - (uint32_t)start) / sizeof(struct hook_data);
|
|
|
|
/* Call all the hooks in priority order */
|
|
while (called < count) {
|
|
/* Find the lowest remaining priority */
|
|
for (p = start, prio = HOOK_PRIO_LAST + 1; p < end; p++) {
|
|
if (p->priority < prio && p->priority > last_prio)
|
|
prio = p->priority;
|
|
}
|
|
last_prio = prio;
|
|
|
|
/* Call all the hooks with that priority */
|
|
for (p = start; p < end; p++) {
|
|
if (p->priority == prio) {
|
|
called++;
|
|
rv = p->routine();
|
|
if (rv != EC_SUCCESS) {
|
|
if (stop_on_error)
|
|
return rv;
|
|
else if (rv_error == EC_SUCCESS)
|
|
rv_error = rv;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Return the first error seen, if any */
|
|
return rv_error;
|
|
}
|