1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * cxd2880_io.c
4 * Sony CXD2880 DVB-T2/T tuner + demodulator driver
5 * register I/O interface functions
6 *
7 * Copyright (C) 2016, 2017, 2018 Sony Semiconductor Solutions Corporation
8 */
9
10 #include "cxd2880_io.h"
11
cxd2880_io_common_write_one_reg(struct cxd2880_io * io,enum cxd2880_io_tgt tgt,u8 sub_address,u8 data)12 int cxd2880_io_common_write_one_reg(struct cxd2880_io *io,
13 enum cxd2880_io_tgt tgt,
14 u8 sub_address, u8 data)
15 {
16 if (!io)
17 return -EINVAL;
18
19 return io->write_regs(io, tgt, sub_address, &data, 1);
20 }
21
cxd2880_io_set_reg_bits(struct cxd2880_io * io,enum cxd2880_io_tgt tgt,u8 sub_address,u8 data,u8 mask)22 int cxd2880_io_set_reg_bits(struct cxd2880_io *io,
23 enum cxd2880_io_tgt tgt,
24 u8 sub_address, u8 data, u8 mask)
25 {
26 int ret;
27
28 if (!io)
29 return -EINVAL;
30
31 if (mask == 0x00)
32 return 0;
33
34 if (mask != 0xff) {
35 u8 rdata = 0x00;
36
37 ret = io->read_regs(io, tgt, sub_address, &rdata, 1);
38 if (ret)
39 return ret;
40
41 data = (data & mask) | (rdata & (mask ^ 0xff));
42 }
43
44 return io->write_reg(io, tgt, sub_address, data);
45 }
46
cxd2880_io_write_multi_regs(struct cxd2880_io * io,enum cxd2880_io_tgt tgt,const struct cxd2880_reg_value reg_value[],u8 size)47 int cxd2880_io_write_multi_regs(struct cxd2880_io *io,
48 enum cxd2880_io_tgt tgt,
49 const struct cxd2880_reg_value reg_value[],
50 u8 size)
51 {
52 int ret;
53 int i;
54
55 if (!io)
56 return -EINVAL;
57
58 for (i = 0; i < size ; i++) {
59 ret = io->write_reg(io, tgt, reg_value[i].addr,
60 reg_value[i].value);
61 if (ret)
62 return ret;
63 }
64
65 return 0;
66 }
67