162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci#include <linux/kernel.h>
362306a36Sopenharmony_ci#include <linux/module.h>
462306a36Sopenharmony_ci#include <linux/of.h>
562306a36Sopenharmony_ci
662306a36Sopenharmony_ci#include "notifier-error-inject.h"
762306a36Sopenharmony_ci
862306a36Sopenharmony_cistatic int priority;
962306a36Sopenharmony_cimodule_param(priority, int, 0);
1062306a36Sopenharmony_ciMODULE_PARM_DESC(priority, "specify OF reconfig notifier priority");
1162306a36Sopenharmony_ci
1262306a36Sopenharmony_cistatic struct notifier_err_inject reconfig_err_inject = {
1362306a36Sopenharmony_ci	.actions = {
1462306a36Sopenharmony_ci		{ NOTIFIER_ERR_INJECT_ACTION(OF_RECONFIG_ATTACH_NODE) },
1562306a36Sopenharmony_ci		{ NOTIFIER_ERR_INJECT_ACTION(OF_RECONFIG_DETACH_NODE) },
1662306a36Sopenharmony_ci		{ NOTIFIER_ERR_INJECT_ACTION(OF_RECONFIG_ADD_PROPERTY) },
1762306a36Sopenharmony_ci		{ NOTIFIER_ERR_INJECT_ACTION(OF_RECONFIG_REMOVE_PROPERTY) },
1862306a36Sopenharmony_ci		{ NOTIFIER_ERR_INJECT_ACTION(OF_RECONFIG_UPDATE_PROPERTY) },
1962306a36Sopenharmony_ci		{}
2062306a36Sopenharmony_ci	}
2162306a36Sopenharmony_ci};
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_cistatic struct dentry *dir;
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_cistatic int err_inject_init(void)
2662306a36Sopenharmony_ci{
2762306a36Sopenharmony_ci	int err;
2862306a36Sopenharmony_ci
2962306a36Sopenharmony_ci	dir = notifier_err_inject_init("OF-reconfig",
3062306a36Sopenharmony_ci		notifier_err_inject_dir, &reconfig_err_inject, priority);
3162306a36Sopenharmony_ci	if (IS_ERR(dir))
3262306a36Sopenharmony_ci		return PTR_ERR(dir);
3362306a36Sopenharmony_ci
3462306a36Sopenharmony_ci	err = of_reconfig_notifier_register(&reconfig_err_inject.nb);
3562306a36Sopenharmony_ci	if (err)
3662306a36Sopenharmony_ci		debugfs_remove_recursive(dir);
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_ci	return err;
3962306a36Sopenharmony_ci}
4062306a36Sopenharmony_ci
4162306a36Sopenharmony_cistatic void err_inject_exit(void)
4262306a36Sopenharmony_ci{
4362306a36Sopenharmony_ci	of_reconfig_notifier_unregister(&reconfig_err_inject.nb);
4462306a36Sopenharmony_ci	debugfs_remove_recursive(dir);
4562306a36Sopenharmony_ci}
4662306a36Sopenharmony_ci
4762306a36Sopenharmony_cimodule_init(err_inject_init);
4862306a36Sopenharmony_cimodule_exit(err_inject_exit);
4962306a36Sopenharmony_ci
5062306a36Sopenharmony_ciMODULE_DESCRIPTION("OF reconfig notifier error injection module");
5162306a36Sopenharmony_ciMODULE_LICENSE("GPL");
5262306a36Sopenharmony_ciMODULE_AUTHOR("Akinobu Mita <akinobu.mita@gmail.com>");
53