1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * rl6347a.c - RL6347A class device shared support
4  *
5  * Copyright 2015 Realtek Semiconductor Corp.
6  *
7  * Author: Oder Chiou <oder_chiou@realtek.com>
8  */
9 
10 #include <linux/module.h>
11 #include <linux/i2c.h>
12 #include <linux/regmap.h>
13 
14 #include "rl6347a.h"
15 
rl6347a_hw_write(void * context,unsigned int reg,unsigned int value)16 int rl6347a_hw_write(void *context, unsigned int reg, unsigned int value)
17 {
18 	struct i2c_client *client = context;
19 	struct rl6347a_priv *rl6347a = i2c_get_clientdata(client);
20 	u8 data[4];
21 	int ret, i;
22 
23 	/* handle index registers */
24 	if (reg <= 0xff) {
25 		rl6347a_hw_write(client, RL6347A_COEF_INDEX, reg);
26 		for (i = 0; i < rl6347a->index_cache_size; i++) {
27 			if (reg == rl6347a->index_cache[i].reg) {
28 				rl6347a->index_cache[i].def = value;
29 				break;
30 			}
31 
32 		}
33 		reg = RL6347A_PROC_COEF;
34 	}
35 
36 	data[0] = (reg >> 24) & 0xff;
37 	data[1] = (reg >> 16) & 0xff;
38 	/*
39 	 * 4 bit VID: reg should be 0
40 	 * 12 bit VID: value should be 0
41 	 * So we use an OR operator to handle it rather than use if condition.
42 	 */
43 	data[2] = ((reg >> 8) & 0xff) | ((value >> 8) & 0xff);
44 	data[3] = value & 0xff;
45 
46 	ret = i2c_master_send(client, data, 4);
47 
48 	if (ret == 4)
49 		return 0;
50 	else
51 		dev_err(&client->dev, "I2C error %d\n", ret);
52 	if (ret < 0)
53 		return ret;
54 	else
55 		return -EIO;
56 }
57 EXPORT_SYMBOL_GPL(rl6347a_hw_write);
58 
rl6347a_hw_read(void * context,unsigned int reg,unsigned int * value)59 int rl6347a_hw_read(void *context, unsigned int reg, unsigned int *value)
60 {
61 	struct i2c_client *client = context;
62 	struct i2c_msg xfer[2];
63 	int ret;
64 	__be32 be_reg, buf = 0x0;
65 	unsigned int index, vid;
66 
67 	/* handle index registers */
68 	if (reg <= 0xff) {
69 		rl6347a_hw_write(client, RL6347A_COEF_INDEX, reg);
70 		reg = RL6347A_PROC_COEF;
71 	}
72 
73 	reg = reg | 0x80000;
74 	vid = (reg >> 8) & 0xfff;
75 
76 	if (AC_VERB_GET_AMP_GAIN_MUTE == (vid & 0xf00)) {
77 		index = (reg >> 8) & 0xf;
78 		reg = (reg & ~0xf0f) | index;
79 	}
80 	be_reg = cpu_to_be32(reg);
81 
82 	/* Write register */
83 	xfer[0].addr = client->addr;
84 	xfer[0].flags = 0;
85 	xfer[0].len = 4;
86 	xfer[0].buf = (u8 *)&be_reg;
87 
88 	/* Read data */
89 	xfer[1].addr = client->addr;
90 	xfer[1].flags = I2C_M_RD;
91 	xfer[1].len = 4;
92 	xfer[1].buf = (u8 *)&buf;
93 
94 	ret = i2c_transfer(client->adapter, xfer, 2);
95 	if (ret < 0)
96 		return ret;
97 	else if (ret != 2)
98 		return -EIO;
99 
100 	*value = be32_to_cpu(buf);
101 
102 	return 0;
103 }
104 EXPORT_SYMBOL_GPL(rl6347a_hw_read);
105 
106 MODULE_DESCRIPTION("RL6347A class device shared support");
107 MODULE_AUTHOR("Oder Chiou <oder_chiou@realtek.com>");
108 MODULE_LICENSE("GPL v2");
109