summaryrefslogtreecommitdiff
path: root/package/lqtapi/src/mps/vmmc-alm.c
blob: 828376fb91f4e115471b8ed7aa2e72a17322ca05 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
#include <linux/kernel.h>

#include "vmmc.h"
#include "vmmc-cmds.h"
#include "vmmc-alm.h"
#include "vmmc-module.h"
#include "mps.h"

static inline struct vmmc_alm *vmmc_module_to_alm(struct vmmc_module *module)
{
	return container_of(module, struct vmmc_alm, module);
}

int vmmc_alm_set_state(struct vmmc_alm *alm, enum vmmc_alm_state state)
{
	int ret;

	ret = vmmc_command_write(alm->vmmc, VMMC_CMD_OPMODE(alm->id), &state);
	if (!ret)
		alm->state = state;

	return ret;
}

enum vmmc_alm_state vmmc_alm_get_state(struct vmmc_alm *alm)
{
	return alm->state;
}

static struct vmmc_alm_coef *vmmc_alm_coef_alloc(unsigned int offset, size_t len)
{
	struct vmmc_alm_coef *coef;

	coef = kzalloc(sizeof(*coef) + sizeof(uint32_t) * DIV_ROUND_UP(len, 4),
			GFP_KERNEL);
	coef->offset = offset;
	coef->len = len;

	return coef;
}

int vmcc_alm_set_coefficents(struct vmmc_alm *alm,
	const struct vmmc_alm_coef *coef_list)
{
	int ret = 0;
	uint32_t cmd;
	struct vmmc_alm_coef *coef;
	struct list_head l;

	INIT_LIST_HEAD(&l);

	coef = vmmc_alm_coef_alloc(0x37, 8);
	coef->data[0] = 0x76d7871d;
	coef->data[1] = 0x7fbb7ff4;
	list_add_tail(&coef->list, &l);
	coef = vmmc_alm_coef_alloc(0x5e, 2);
	coef->data[0] = 0x7e000000;
	list_add_tail(&coef->list, &l);
	coef = vmmc_alm_coef_alloc(0x6c, 2);
	coef->data[0] = 0x7e000000;
	list_add_tail(&coef->list, &l);

	list_for_each_entry(coef, &l, list) {
		cmd = VMMC_CMD_ALM_COEF(alm->id, coef->offset, coef->len);
		ret = vmmc_command_write(alm->vmmc, cmd, coef->data);
		if (ret)
			break;
	}

	return ret;
}

static int vmmc_alm_sync(struct vmmc_module *module)
{
	struct vmmc_alm *alm = vmmc_module_to_alm(module);

	alm->cmd_cache[0] = VMMC_CMD_ALI_DATA1(1, 0, 0, 1, 0, module->pins[0], 0x4000);
	alm->cmd_cache[1] = VMMC_CMD_ALI_DATA2(0x4000, module->pins[1], module->pins[2]);
	alm->cmd_cache[2] = VMMC_CMD_ALI_DATA3(module->pins[3], module->pins[4]);

	return vmmc_command_write(alm->vmmc, VMMC_CMD_ALI(alm->id), alm->cmd_cache);
}

static int vmmc_alm_enable(struct vmmc_module *module, bool enable)
{
	struct vmmc_alm *alm = vmmc_module_to_alm(module);

	return vmmc_command_write(alm->vmmc, VMMC_CMD_ALI(alm->id), alm->cmd_cache);
}

static const struct vmmc_module_ops vmmc_alm_module_ops = {
	.sync = vmmc_alm_sync,
	.enable = vmmc_alm_enable,
};

int vmmc_alm_init(struct vmmc_alm *alm, struct vmmc *vmmc, unsigned int id)
{
	int ret;

	ret = vmmc_module_init(&alm->module, 5, &vmmc_alm_module_ops);
	if (ret)
		return ret;

	alm->id = id;
	alm->module.id = id + 0x4;
	alm->vmmc = vmmc;

	alm->cmd_cache[0] = VMMC_CMD_ALI_DATA1(1, 0, 0, 1, 0, 0, 0x2000);
	alm->cmd_cache[1] = VMMC_CMD_ALI_DATA2(0x2000, 0, 0);
	alm->cmd_cache[2] = VMMC_CMD_ALI_DATA3(0, 0);

	vmmc_command_write(alm->vmmc, VMMC_CMD_ALI(alm->id), alm->cmd_cache);
	vmcc_alm_set_coefficents(alm, NULL);
	vmmc_register_module(vmmc, &alm->module);

// disable lec
// write lec coef
// write nlp coef
// enable lec

// ALI_LEC ALI_ES RES_LEC_COEF RES_LEC_NLP_COEF

	return ret;
}

void vmmc_alm_hook_event_handler(struct vmmc *vmmc, uint32_t id, uint32_t data)
{
	tapi_report_hook_event(&vmmc->tdev, &vmmc->tdev.ports[id], data & 1);
}