Orange Pi5 kernel

/* SPDX-License-Identifier: GPL-2.0 */
/*
 * TP  suspend Control Abstraction
 *
 * Copyright (C) RK Company
 *
 */
#ifndef _RK_TP_SUSPEND_H
#define _RK_TP_SUSPEND_H
#include <linux/module.h>
#include <linux/init.h>
#include <linux/device.h>
#include <linux/err.h>
#include <linux/fb.h>
#include <linux/notifier.h>
#include "../../gpu/drm/rockchip/ebc-dev/ebc_dev.h"

struct  tp_device{
	struct notifier_block fb_notif;
	struct notifier_block ebc_notif;
	int(*tp_suspend)(struct  tp_device*);
	int(*tp_resume)(struct  tp_device*);
	struct mutex ops_lock;
	int status;
};

static inline int fb_notifier_callback(struct notifier_block *self,
				unsigned long action, void *data)
{
	struct tp_device *tp;
	struct fb_event *event = data;
	int blank_mode;
	int ret = 0;

	tp = container_of(self, struct tp_device, fb_notif);

	if (action != FB_EVENT_BLANK)
		return NOTIFY_DONE;

	mutex_lock(&tp->ops_lock);

	blank_mode = *((int *)event->data);
	//printk("%s.....lin=%d tp->status=%x,blank_mode=%x\n",__func__,__LINE__,tp->status,blank_mode);

	switch (blank_mode) {
	case FB_BLANK_UNBLANK:
		if (tp->status != FB_BLANK_UNBLANK) {
			tp->status = blank_mode;
			tp->tp_resume(tp);
		}
		break;
	default:
		if (tp->status == FB_BLANK_UNBLANK) {
			tp->status = blank_mode;
			ret = tp->tp_suspend(tp);
		}
		break;
	}

	mutex_unlock(&tp->ops_lock);

	if (ret < 0)
	{
		printk("TP_notifier_callback error action=%x,blank_mode=%x\n",(int)action,blank_mode);
		return ret;
	}

	return NOTIFY_OK;
}

static int ebc_notifier_callback(struct notifier_block *self,
		unsigned long action, void *data)
{
	struct tp_device *tp;

	tp = container_of(self, struct tp_device, ebc_notif);

	mutex_lock(&tp->ops_lock);

	if (action == EBC_FB_BLANK)
		tp->tp_suspend(tp);
	else if (action == EBC_FB_UNBLANK)
		tp->tp_resume(tp);

	mutex_unlock(&tp->ops_lock);

	return NOTIFY_OK;
}

static inline int tp_register_fb(struct tp_device *tp)
{
	memset(&tp->fb_notif, 0, sizeof(tp->fb_notif));
	tp->fb_notif.notifier_call = fb_notifier_callback;
	tp->ebc_notif.notifier_call = ebc_notifier_callback;
	mutex_init(&tp->ops_lock);
	tp->status = FB_BLANK_UNBLANK;

	ebc_register_notifier(&tp->ebc_notif);
	fb_register_client(&tp->fb_notif);

	return 0;
}

static inline void tp_unregister_fb(struct tp_device *tp)
{
	ebc_unregister_notifier(&tp->ebc_notif);
	fb_unregister_client(&tp->fb_notif);
}
#endif