bc0560f6fa
The audio PDR driver is used to control the process domain restart recovery mechanism. The audio SSR driver is used to control the Subsystem Restart recovery mechanism. Both are controlled through the Audio Notifier driver which determines whether PDR or SSR is used and provides the core interface to all audio drivers. Change-Id: I15325c1385eaa0f0cca2c07130f2b4a997d98e1f CRs-Fixed: 1054000 Signed-off-by: Ben Romberger <bromberg@codeaurora.org>
148 lines
4 KiB
C
148 lines
4 KiB
C
/* Copyright (c) 2016, The Linux Foundation. All rights reserved.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 and
|
|
* only version 2 as published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/qdsp6v2/audio_pdr.h>
|
|
#include <soc/qcom/service-locator.h>
|
|
#include <soc/qcom/service-notifier.h>
|
|
|
|
static struct pd_qmi_client_data audio_pdr_services[AUDIO_PDR_DOMAIN_MAX] = {
|
|
{ /* AUDIO_PDR_DOMAIN_ADSP */
|
|
.client_name = "audio_pdr_adsp",
|
|
.service_name = "avs/audio"
|
|
}
|
|
};
|
|
|
|
struct srcu_notifier_head audio_pdr_cb_list;
|
|
|
|
static int audio_pdr_locator_callback(struct notifier_block *this,
|
|
unsigned long opcode, void *data)
|
|
{
|
|
unsigned long pdr_state = AUDIO_PDR_FRAMEWORK_DOWN;
|
|
|
|
if (opcode == LOCATOR_DOWN) {
|
|
pr_debug("%s: Service %s is down!", __func__,
|
|
audio_pdr_services[AUDIO_PDR_DOMAIN_ADSP].
|
|
service_name);
|
|
goto done;
|
|
}
|
|
|
|
memcpy(&audio_pdr_services, data,
|
|
sizeof(audio_pdr_services[AUDIO_PDR_DOMAIN_ADSP]));
|
|
if (audio_pdr_services[AUDIO_PDR_DOMAIN_ADSP].total_domains == 1) {
|
|
pr_debug("%s: Service %s, returned total domains %d, ",
|
|
__func__,
|
|
audio_pdr_services[AUDIO_PDR_DOMAIN_ADSP].service_name,
|
|
audio_pdr_services[AUDIO_PDR_DOMAIN_ADSP].
|
|
total_domains);
|
|
pdr_state = AUDIO_PDR_FRAMEWORK_UP;
|
|
goto done;
|
|
} else
|
|
pr_err("%s: Service %s returned invalid total domains %d",
|
|
__func__,
|
|
audio_pdr_services[AUDIO_PDR_DOMAIN_ADSP].service_name,
|
|
audio_pdr_services[AUDIO_PDR_DOMAIN_ADSP].
|
|
total_domains);
|
|
done:
|
|
srcu_notifier_call_chain(&audio_pdr_cb_list, pdr_state, NULL);
|
|
return NOTIFY_OK;
|
|
}
|
|
|
|
static struct notifier_block audio_pdr_locator_nb = {
|
|
.notifier_call = audio_pdr_locator_callback,
|
|
.priority = 0,
|
|
};
|
|
|
|
int audio_pdr_register(struct notifier_block *nb)
|
|
{
|
|
if (nb == NULL) {
|
|
pr_err("%s: Notifier block is NULL\n", __func__);
|
|
return -EINVAL;
|
|
}
|
|
return srcu_notifier_chain_register(&audio_pdr_cb_list, nb);
|
|
}
|
|
EXPORT_SYMBOL(audio_pdr_register);
|
|
|
|
void *audio_pdr_service_register(int domain_id,
|
|
struct notifier_block *nb, int *curr_state)
|
|
{
|
|
void *handle;
|
|
|
|
if ((domain_id < 0) ||
|
|
(domain_id >= AUDIO_PDR_DOMAIN_MAX)) {
|
|
pr_err("%s: Invalid service ID %d\n", __func__, domain_id);
|
|
return ERR_PTR(-EINVAL);
|
|
}
|
|
|
|
handle = service_notif_register_notifier(
|
|
audio_pdr_services[domain_id].domain_list[0].name,
|
|
audio_pdr_services[domain_id].domain_list[0].instance_id,
|
|
nb, curr_state);
|
|
if (IS_ERR_OR_NULL(handle)) {
|
|
pr_err("%s: Failed to register for service %s, instance %d\n",
|
|
__func__,
|
|
audio_pdr_services[domain_id].domain_list[0].name,
|
|
audio_pdr_services[domain_id].domain_list[0].
|
|
instance_id);
|
|
}
|
|
return handle;
|
|
}
|
|
EXPORT_SYMBOL(audio_pdr_service_register);
|
|
|
|
int audio_pdr_service_deregister(void *service_handle,
|
|
struct notifier_block *nb)
|
|
{
|
|
int ret;
|
|
|
|
if (service_handle == NULL) {
|
|
pr_err("%s: service handle is NULL\n", __func__);
|
|
ret = -EINVAL;
|
|
goto done;
|
|
}
|
|
|
|
ret = service_notif_unregister_notifier(
|
|
service_handle, nb);
|
|
if (IS_ERR_VALUE(ret))
|
|
pr_err("%s: Failed to deregister service ret %d\n",
|
|
__func__, ret);
|
|
done:
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL(audio_pdr_service_deregister);
|
|
|
|
static int __init audio_pdr_subsys_init(void)
|
|
{
|
|
srcu_init_notifier_head(&audio_pdr_cb_list);
|
|
return 0;
|
|
}
|
|
subsys_initcall(audio_pdr_subsys_init);
|
|
|
|
static int __init audio_pdr_late_init(void)
|
|
{
|
|
int ret;
|
|
|
|
ret = get_service_location(
|
|
audio_pdr_services[AUDIO_PDR_DOMAIN_ADSP].client_name,
|
|
audio_pdr_services[AUDIO_PDR_DOMAIN_ADSP].service_name,
|
|
&audio_pdr_locator_nb);
|
|
if (IS_ERR_VALUE(ret)) {
|
|
pr_err("%s get_service_location failed ret %d\n",
|
|
__func__, ret);
|
|
srcu_notifier_call_chain(&audio_pdr_cb_list,
|
|
AUDIO_PDR_FRAMEWORK_DOWN, NULL);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
late_initcall(audio_pdr_late_init);
|
|
|