drivers/cam_req_mgr/cam_req_mgr_timer.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
 */

#include "cam_req_mgr_timer.h"
#include "cam_debug_util.h"

extern struct kmem_cache *g_cam_req_mgr_timer_cachep;

void crm_timer_reset(struct cam_req_mgr_timer *crm_timer)
{
	if (!crm_timer)
		return;
	CAM_DBG(CAM_CRM, "Starting timer to fire in %d ms. (jiffies=%lu)\n",
		crm_timer->expires, jiffies);
	mod_timer(&crm_timer->sys_timer,
		(jiffies + msecs_to_jiffies(crm_timer->expires)));
}
EXPORT_SYMBOL_GPL(crm_timer_reset);

void crm_timer_callback(struct timer_list *timer_data)
{
	struct cam_req_mgr_timer *timer =
		container_of(timer_data, struct cam_req_mgr_timer, sys_timer);
	if (!timer) {
		CAM_ERR(CAM_CRM, "NULL timer");
		return;
	}
	CAM_DBG(CAM_CRM, "timer %pK parent %pK", timer, timer->parent);
	crm_timer_reset(timer);
}

void crm_timer_modify(struct cam_req_mgr_timer *crm_timer,
	int32_t expires)
{
	CAM_DBG(CAM_CRM, "new time %d", expires);
	if (crm_timer) {
		crm_timer->expires = expires;
		crm_timer_reset(crm_timer);
	}
}

int crm_timer_init(struct cam_req_mgr_timer **timer,
	int32_t expires, void *parent, void (*timer_cb)(struct timer_list *))
{
	int                       ret = 0;
	struct cam_req_mgr_timer *crm_timer = NULL;

	CAM_DBG(CAM_CRM, "init timer %d %pK", expires, *timer);
	if (*timer == NULL) {
		if (g_cam_req_mgr_timer_cachep) {
			crm_timer = kmem_cache_alloc(g_cam_req_mgr_timer_cachep,
					__GFP_ZERO | GFP_KERNEL);
			if (!crm_timer) {
				ret = -ENOMEM;
				goto end;
			}
		}

		else {
			ret = -ENOMEM;
			goto end;
		}

		if (timer_cb != NULL)
			crm_timer->timer_cb = timer_cb;
		else
			crm_timer->timer_cb = crm_timer_callback;

		crm_timer->expires = expires;
		crm_timer->parent = parent;
		timer_setup(&crm_timer->sys_timer,
			crm_timer->timer_cb, 0);
		crm_timer_reset(crm_timer);
		*timer = crm_timer;
	} else {
		CAM_WARN(CAM_CRM, "Timer already exists!!");
		ret = -EINVAL;
	}
end:
	return ret;
}
EXPORT_SYMBOL_GPL(crm_timer_init);
void crm_timer_exit(struct cam_req_mgr_timer **crm_timer)
{
	CAM_DBG(CAM_CRM, "destroy timer %pK @ %pK", *crm_timer, crm_timer);
	if (*crm_timer) {
		del_timer_sync(&(*crm_timer)->sys_timer);
		if (g_cam_req_mgr_timer_cachep)
			kmem_cache_free(g_cam_req_mgr_timer_cachep, *crm_timer);
		*crm_timer = NULL;
	}
}
EXPORT_SYMBOL_GPL(crm_timer_exit);