/* SPDX-License-Identifier: GPL-2.0-or-later */
/*
 * ROCKCDSI (Rockchip Commercial Display System Interface)
 *
 * -- Power module
 *
 * Copyright (C) 2024 Rockchip Electronics Co., Ltd.
 *
 */

#include <hardware/hardware.h>
#include <linux/types.h>
#include <sys/ioctl.h>
#include <errno.h>
#include <log/log.h>
#include "PowerModule.h"

#ifdef LOG_TAG
#undef LOG_TAG
#define LOG_TAG "rockcdsi_power"
#endif

struct rk_vendor_req {
	__u32 tag;
	__u16 id;
	__u16 len;
	__u8 data[1];
};

#define VENDOR_REQ_TAG   0x56524551
#define VENDOR_READ_IO   _IOW('v', 0x01, struct rk_vendor_req)
#define VENDOR_WRITE_IO  _IOW('v', 0x02, struct rk_vendor_req)

#define VENDOR_POWERMODE_ID 0x22

/*
 * Get power-on mode
 * @return mode, range[ui_power_mode_t]
 */
static ui_power_mode_t get_power_mode(struct power_hal_module *module)
{
	int ret = 0;
	__u8 p_buf[40];
	struct rk_vendor_req *req;

	req = (struct rk_vendor_req *)p_buf;
	int sys_fd = open("/dev/vendor_storage", O_RDWR, 0);
	if(sys_fd < 0) {
		ALOGD("vendor_storage open fail\n");
		return 1;
	}

	req->tag = VENDOR_REQ_TAG;
	req->id = VENDOR_POWERMODE_ID;
	req->len = 1;

	ret = ioctl(sys_fd, VENDOR_READ_IO, req);
	/* return req->len is the real data length stored in the NV-storage */
	if(ret){
		ALOGD("vendor read error n");
		ret = 1;
	}

	close(sys_fd);

	return ret;
}

/*
 * Set power-on mode
 * @param value: mode, range[ui_power_mode_t]
 * @return result [0: successfully, 1: failure]
 * @note default: POWER_MODE_OFF, power-off will save
 */
static int set_power_mode(struct power_hal_module *module, ui_power_mode_t value)
{

	int ret;
	__u8 p_buf[40];
	struct rk_vendor_req *req;

	if (value > POWER_MODE_LAST){
		ALOGD("mode val is invalid!!!\n");
		return 1;
	}

	req = (struct rk_vendor_req *)p_buf;
	int sys_fd = open("/dev/vendor_storage", O_RDWR, 0);
	if(sys_fd < 0) {
		ALOGD("vendor_storage open fail\n");
		return 1;
	}

	req->tag = VENDOR_REQ_TAG;
	req->id = VENDOR_POWERMODE_ID;
	req->len = 1; /* max read length to read*/

	req->data[0] = value;

	ret = ioctl(sys_fd, VENDOR_WRITE_IO, req);
	if(ret){
		ALOGD("vendor read error n");
		ret = 1;
	}

	close(sys_fd);

	return 0;
}

static struct hw_module_methods_t power_hal_module_methods =
{
	.open = NULL,
};

struct power_hal_module HAL_MODULE_INFO_SYM =
{
	.common = {
		.tag = HARDWARE_MODULE_TAG,
		.module_api_version = POWER_HAL_MODULE_API_VERSION,
		.hal_api_version = HARDWARE_HAL_API_VERSION,
		.id = POWER_HAL_HARDWARE_MODULE_ID,
		.name ="Default Power HAL",
		.author = "The Power Project",
		.methods = &power_hal_module_methods,
	},
	.get_power_mode = get_power_mode,
	.set_power_mode = set_power_mode,
};