/* SPDX-License-Identifier: GPL-2.0 */
/*
 * Copyright (c) 2019 MediaTek Inc.
 */

#ifndef __MTK_UDI_INTERNAL_H__
#define __MTK_UDI_INTERNAL_H__

#include <mtk_udi.h>


#ifdef __KERNEL__
#include <linux/arm-smccc.h>
#include <linux/kernel.h>
#endif


/* define for UDI service */
#ifdef CONFIG_ARM64
#define MTK_SIP_KERNEL_UDI_JTAG_CLOCK		0xC20003A0
#define MTK_SIP_KERNEL_UDI_BIT_CTRL			0xC20003A1
#define MTK_SIP_KERNEL_UDI_WRITE			0xC20003A2
#define MTK_SIP_KERNEL_UDI_READ				0xC20003A3
#else
#define MTK_SIP_KERNEL_UDI_JTAG_CLOCK		0x820003A0
#define MTK_SIP_KERNEL_UDI_BIT_CTRL			0x820003A1
#define MTK_SIP_KERNEL_UDI_WRITE			0x820003A2
#define MTK_SIP_KERNEL_UDI_READ				0x820003A3
#endif

/*
 * bit operation
 */
#define BIT_UDI(bit)		(1U << (bit))

#define MSB_UDI(range)	(1 ? range)
#define LSB_UDI(range)	(0 ? range)
/**
 * Genearte a mask wher MSB to LSB are all 0b1
 * @r: Range in the form of MSB:LSB
 */
#define BITMASK_UDI(r) \
	(((unsigned int) -1 >> (31 - MSB_UDI(r))) & ~((1U << LSB_UDI(r)) - 1))

#define GET_BITS_VAL_UDI(_bits_, _val_) \
	(((_val_) & (BITMASK_UDI(_bits_))) >> ((0) ? _bits_))

/**
 * Set value at MSB:LSB. For example, BITS(7:3, 0x5A)
 * will return a value where bit 3 to bit 7 is 0x5A
 * @r:	Range in the form of MSB:LSB
 */
/* BITS(MSB:LSB, value) => Set value at MSB:LSB  */
#define BITS_UDI(r, val)	((val << LSB_UDI(r)) & BITMASK_UDI(r))

#define udi_reg_field(addr, range, val)	\
	udi_reg_write(addr, (udi_reg_read(addr) & ~(BITMASK_UDI(range)))\
					| BITS_UDI(range, val))

extern unsigned int udi_reg_read(unsigned int addr);
extern void udi_reg_write(unsigned int addr,
				unsigned int val);

#endif /* __MTK_UDI_INTERNAL_H__ */