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



/* ************************** */
/* Include Header File */
/* ************************** */
#include "AfInit.h"
#include "AfData.h"

#define REG_ADDR_START 0x80 /* REG Start address */

void AfInit(unsigned char hall_off, unsigned char hall_bias)
{
	unsigned int DataLen;
	unsigned short i;
	unsigned short pos;

	if (g_LC898212_SearchDir == 0) {
		/* IMX230, OV23850 */
		DataLen = sizeof(Init_Table_TVC820) / sizeof(IniData);

		for (i = 0; i < DataLen; i++) {
			if (Init_Table_TVC820[i].addr == WAIT) {
				WaitTime(Init_Table_TVC820[i].data);
				continue;
			}

			if (Init_Table_TVC820[i].addr >= REG_ADDR_START)
				RegWriteA(Init_Table_TVC820[i].addr,
					  (unsigned char)(Init_Table_TVC820[i]
								  .data &
							  0x00ff));
			else
				RamWriteA(Init_Table_TVC820[i].addr,
					  (unsigned short)Init_Table_TVC820[i]
						  .data);
		}
	} else {
		/* IMX214, IMX258 */
		DataLen = sizeof(Init_Table_TVC651) / sizeof(IniData);

		for (i = 0; i < DataLen; i++) {
			if (Init_Table_TVC651[i].addr == WAIT) {
				WaitTime(Init_Table_TVC651[i].data);
				continue;
			}

			if (Init_Table_TVC651[i].addr >= REG_ADDR_START)
				RegWriteA(Init_Table_TVC651[i].addr,
					  (unsigned char)(Init_Table_TVC651[i]
								  .data &
							  0x00ff));
			else
				RamWriteA(Init_Table_TVC651[i].addr,
					  (unsigned short)Init_Table_TVC651[i]
						  .data);
		}
	}

	RegWriteA(0x28, hall_off);  /* Hall Offset */
	RegWriteA(0x29, hall_bias); /* Hall Bias */

	RamReadA(0x3C, &pos);
	RamWriteA(0x04, pos); /* Direct move target position */
	RamWriteA(0x18, pos); /* Step move start position */

	/* WaitTime(5); */
	/* RegWriteA( 0x87, 0x85 );              // Servo ON */
}

void ServoOn(void)
{
	RegWriteA(0x85, 0x80); /* Clear PID Ram Data */
	WaitTime(1);
	RegWriteA(0x87, 0x85); /* Servo ON */
}