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)
81 lines
1.9 KiB
C
81 lines
1.9 KiB
C
/*
|
|
* Copyright (C) 2015 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 the
|
|
* GNU General Public License for more details.
|
|
*/
|
|
|
|
#ifdef DEBUG_LOG
|
|
#include <linux/fs.h>
|
|
#endif
|
|
#include <linux/delay.h>
|
|
#include <linux/i2c.h>
|
|
#define DeviceAddr 0xE4
|
|
|
|
#include "AfSTMV.h"
|
|
|
|
#ifdef DEBUG_LOG
|
|
#define AF_REGDUMP "REGDUMP"
|
|
#define LOG_INF(format, args...) pr_info(AF_REGDUMP " " format, ##args)
|
|
#endif
|
|
|
|
void RamWriteA(unsigned short addr, unsigned short data)
|
|
{
|
|
u8 puSendCmd[3] = {(u8)(addr & 0xFF), (u8)(data >> 8),
|
|
(u8)(data & 0xFF)};
|
|
|
|
s4AF_WriteReg_LC898212XDAF(puSendCmd, sizeof(puSendCmd), DeviceAddr);
|
|
|
|
#ifdef DEBUG_LOG
|
|
LOG_INF("RAMW\t%x\t%x\n", addr, data);
|
|
#endif
|
|
}
|
|
|
|
void RamReadA(unsigned short addr, unsigned short *data)
|
|
{
|
|
u8 buf[2];
|
|
u8 puSendCmd[1] = {(u8)(addr & 0xFF)};
|
|
|
|
s4AF_ReadReg_LC898212XDAF(puSendCmd, sizeof(puSendCmd), buf, 2,
|
|
DeviceAddr);
|
|
*data = (buf[0] << 8) | (buf[1] & 0x00FF);
|
|
|
|
#ifdef DEBUG_LOG
|
|
LOG_INF("RAMR\t%x\t%x\n", addr, *data);
|
|
#endif
|
|
}
|
|
|
|
void RegWriteA(unsigned short addr, unsigned char data)
|
|
{
|
|
u8 puSendCmd[2] = {(u8)(addr & 0xFF), (u8)(data & 0xFF)};
|
|
|
|
s4AF_WriteReg_LC898212XDAF(puSendCmd, sizeof(puSendCmd), DeviceAddr);
|
|
|
|
#ifdef DEBUG_LOG
|
|
LOG_INF("REGW\t%x\t%x\n", addr, data);
|
|
#endif
|
|
}
|
|
|
|
void RegReadA(unsigned short addr, unsigned char *data)
|
|
{
|
|
u8 puSendCmd[1] = {(u8)(addr & 0xFF)};
|
|
|
|
s4AF_ReadReg_LC898212XDAF(puSendCmd, sizeof(puSendCmd), data, 1,
|
|
DeviceAddr);
|
|
|
|
#ifdef DEBUG_LOG
|
|
LOG_INF("REGR\t%x\t%x\n", addr, *data);
|
|
#endif
|
|
}
|
|
|
|
void WaitTime(unsigned short msec)
|
|
{
|
|
usleep_range(msec * 1000, (msec + 1) * 1000);
|
|
}
|