threeeye
bc1d038eac
Squashed backup commit (no shallow-clone history issues) of xiaomi-mt6833-dev/kernel_xiaomi_mt6833 (lineage-23.2 branch, upstream commit 9eece662e) plus all fixes applied to get everpal_defconfig building clean against a modern (GCC 15.2.0) toolchain -- see the previous commit message on the lineage-23.2 branch (also in this repo history is not available here since this is a squashed snapshot; full incremental history lives in the local DL380 checkout and the upstream GitHub remote). Upstream: https://github.com/xiaomi-mt6833-dev/kernel_xiaomi_mt6833 (lineage-23.2)
87 lines
2.2 KiB
C
87 lines
2.2 KiB
C
/*
|
|
* Copyright (C) 2016 MediaTek Inc.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
|
|
* See http://www.gnu.org/licenses/gpl-2.0.html for more details.
|
|
*/
|
|
|
|
/* ************************** */
|
|
/* 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 */
|
|
}
|