1 files changed, 221 insertions, 0 deletions

diff --git a/package/lqtapi/src/mps/vmmc-coder.c b/package/lqtapi/src/mps/vmmc-coder.c
new file mode 100644
index 000000000..087a53bc7
--- /dev/null
+++ b/package/lqtapi/src/mps/vmmc-coder.c
@@ -0,0 +1,221 @@
+#include <linux/kernel.h>
+
+#include "vmmc.h"
+#include "vmmc-cmds.h"
+#include "vmmc-coder.h"
+#include "vmmc-module.h"
+#include "mps.h"
+
+enum vmmc_coder_encoding {
+	VMMC_CODER_ENCODING_ALAW = 2,
+	VMMC_CODER_ENCODING_MLAW = 3,
+	VMMC_CODER_ENCODING_G726_16 = 4,
+	VMMC_CODER_ENCODING_G726_24 = 5,
+	VMMC_CODER_ENCODING_G726_32 = 6,
+	VMMC_CODER_ENCODING_G726_40 = 7,
+	VMMC_CODER_ENCODING_AMR_4_75 = 8,
+	VMMC_CODER_ENCODING_AMR_5_15 = 9,
+	VMMC_CODER_ENCODING_AMR_5_9 = 10,
+	VMMC_CODER_ENCODING_AMR_6_7 = 11,
+	VMMC_CODER_ENCODING_AMR_7_4 = 12,
+	VMMC_CODER_ENCODING_AMR_7_95 = 13,
+	VMMC_CODER_ENCODING_AMR_10_2 = 14,
+	VMMC_CODER_ENCODING_AMR_12_2 = 15,
+	VMMC_CODER_ENCODING_G728_16 = 16,
+	VMMC_CODER_ENCODING_G729AB_8 = 18,
+	VMMC_CODER_ENCODING_G729E_11_8 = 19,
+	VMMC_CODER_ENCODING_G7221_24 = 20,
+	VMMC_CODER_ENCODING_G7221_32 = 21,
+	VMMC_CODER_ENCODING_G722_64 = 22,
+	VMMC_CODER_ENCODING_L16_8 = 24,
+	VMMC_CODER_ENCODING_L16_16 = 25,
+	VMMC_CODER_ENCODING_ILBC_15_2 = 26,
+	VMMC_CODER_ENCODING_ILBC_13_3 = 27,
+	VMMC_CODER_ENCODING_G7231_5_3 = 28,
+	VMMC_CODER_ENCODING_G7231_6_3 = 29,
+	VMMC_CODER_ENCODING_ALAW_VBD = 30,
+	VMMC_CODER_ENCODING_MLAW_VBD = 31,
+};
+
+static const uint8_t vmmc_coder_payload_mapping[] = {
+	[VMMC_CODER_ENCODING_ALAW] = 8,
+	[VMMC_CODER_ENCODING_MLAW] = 0,
+	[VMMC_CODER_ENCODING_G726_16] = 35,
+	[VMMC_CODER_ENCODING_G726_24] = 36,
+	[VMMC_CODER_ENCODING_G726_32] = 37,
+	[VMMC_CODER_ENCODING_G726_40] = 38,
+	[VMMC_CODER_ENCODING_AMR_4_75] = 39,
+	[VMMC_CODER_ENCODING_AMR_5_15] = 40,
+	[VMMC_CODER_ENCODING_AMR_5_9] = 41,
+	[VMMC_CODER_ENCODING_AMR_6_7] = 42,
+	[VMMC_CODER_ENCODING_AMR_7_4] = 43,
+	[VMMC_CODER_ENCODING_AMR_7_95] = 44,
+	[VMMC_CODER_ENCODING_AMR_10_2] = 45,
+	[VMMC_CODER_ENCODING_AMR_12_2] = 46,
+	[VMMC_CODER_ENCODING_G728_16] = 47,
+	[VMMC_CODER_ENCODING_G729AB_8] = 48,
+	[VMMC_CODER_ENCODING_G729E_11_8] = 49,
+	[VMMC_CODER_ENCODING_G7221_24] = 50,
+	[VMMC_CODER_ENCODING_G7221_32] = 51,
+	[VMMC_CODER_ENCODING_G722_64] = 52,
+	[VMMC_CODER_ENCODING_L16_8] = 11,
+	[VMMC_CODER_ENCODING_L16_16] = 10,
+	[VMMC_CODER_ENCODING_ILBC_15_2] = 53,
+	[VMMC_CODER_ENCODING_ILBC_13_3] = 54,
+	[VMMC_CODER_ENCODING_G7231_5_3] = 4,
+	[VMMC_CODER_ENCODING_G7231_6_3] = 4,
+	[VMMC_CODER_ENCODING_ALAW_VBD] = 55,
+	[VMMC_CODER_ENCODING_MLAW_VBD] = 56,
+};
+
+static uint32_t payload_enc[9];
+static uint32_t payload_dec[8];
+
+static inline struct vmmc_coder *vmmc_module_to_coder(struct vmmc_module *module)
+{
+	return container_of(module, struct vmmc_coder, module);
+}
+
+static int vmmc_coder_enable(struct vmmc_module *module, bool enable)
+{
+	struct vmmc_coder *coder = vmmc_module_to_coder(module);
+
+	coder->enabled = enable;
+
+/*	coder->cmd_cache[0] = VMMC_CMD_CODER_DATA1(coder->enabled, 0, 0, 0, coder->id,
+		module->pins[0], 0, 0, 0, 0, 0, 0, 0, 0, 0, 0);
+	return vmmc_command_write(coder->vmmc, VMMC_CMD_CODER(coder->id),
+	coder->cmd_cache);*/
+	return 0;
+}
+
+static int vmmc_coder_sync(struct vmmc_module *module)
+{
+	struct vmmc_coder *coder = vmmc_module_to_coder(module);
+
+	coder->cmd_cache[0] = VMMC_CMD_CODER_DATA1(coder->enabled, 0, 1, 1, coder->id,
+		module->pins[0], 1, 1, 1, 1, 1, 1, 0, 0, 0, VMMC_CODER_ENCODING_MLAW);
+	coder->cmd_cache[1] = VMMC_CMD_CODER_DATA2(0x2000, 0x2000);
+	coder->cmd_cache[2] = VMMC_CMD_CODER_DATA3(0, 0, module->pins[1], 0,
+		module->pins[2], 0, module->pins[3], module->pins[4]);
+
+	return vmmc_command_write(coder->vmmc, VMMC_CMD_CODER(coder->id), coder->cmd_cache);
+}
+
+static const struct vmmc_module_ops vmmc_coder_module_ops = {
+	.sync = vmmc_coder_sync,
+	.enable = vmmc_coder_enable,
+};
+
+#define VMMC_CMD_CODER_JB(_chan) (_VMMC_MSG(6, 3, 18) | _VMMC_CHAN(_chan) | 8)
+#define VMMC_CMD_CODER_JB_DATA1(_sf, _prp, _pje, _dvf, _nam, _rad, _adap, _init_pod) \
+	(((_sf) << 31) | ((_prp) << 23) | ((_pje) << 22) | ((_dvf) << 21) | \
+	((_nam) << 20) | ((_rad) << 17) | ((_adap) << 16) | (_init_pod))
+#define VMMC_CMD_CODER_JB_DATA2(_min_pod, _max_pod) \
+	(((_min_pod) << 16) | (_max_pod))
+#define VMMC_CMD_CODER_JB_DATA3(_adap_factor, _min_margin, _mode) \
+	(((_adap_factor) << 24) | ((_min_margin) << 16) | (_mode))
+
+int vmmc_coder_init(struct vmmc_coder *coder, struct vmmc *vmmc, unsigned int id)
+{
+	int ret;
+
+	ret = vmmc_module_init(&coder->module, 5, &vmmc_coder_module_ops);
+	if (ret)
+		return ret;
+
+	coder->id = id;
+	coder->module.id = id + 0x18;
+	coder->vmmc = vmmc;
+	coder->enabled = 0;
+
+	coder->cmd_cache[0] = VMMC_CMD_CODER_DATA1(0, 0, 0, 0, id, 0,
+		0, 0, 0, 0, 0, 0, 0, 0, 0, 0);
+	coder->cmd_cache[1] = VMMC_CMD_CODER_DATA2(0, 0);
+	coder->cmd_cache[2] = VMMC_CMD_CODER_DATA3(0, 0, 0, 0, 0, 0, 0, 0);
+	coder->cmd_cache[3] = VMMC_CMD_CODER_DATA4(0);
+
+	coder->jitter_buffer_cache[0] = VMMC_CMD_CODER_JB_DATA1(0x16, 1, 0, 0, 1, 1,
+	1, 0x50);
+	coder->jitter_buffer_cache[1] = VMMC_CMD_CODER_JB_DATA2(0x50, 0x05a0);
+	coder->jitter_buffer_cache[2] = VMMC_CMD_CODER_JB_DATA3(0x0d, 0x28, 1);
+
+	vmmc_command_write(coder->vmmc, VMMC_CMD_RTP_CFG_US(coder->id), payload_enc);
+	vmmc_command_write(coder->vmmc, VMMC_CMD_RTP_CFG_DS(coder->id), payload_dec);
+	vmmc_command_write(coder->vmmc, VMMC_CMD_CODER_JB(coder->id),
+	coder->jitter_buffer_cache);
+	vmmc_command_write(coder->vmmc, VMMC_CMD_CODER(coder->id), coder->cmd_cache);
+
+	vmmc_register_module(vmmc, &coder->module);
+
+	return ret;
+}
+
+void vmmc_coder_event(struct vmmc *vmmc, unsigned int chan, unsigned int type)
+{
+}
+
+/*
+void vmmc_coder_event(struct vmmc_coder *coder, unsigned int len)
+{
+	struct sk_buff *skb;
+	provide_mem_region(coder->vmmc, vmmc_coder_alloc_paket(coder)->head, 512);
+
+	skb = skb_dequeue(&coder->paket_queue);
+	skb_put(skb, len);
+
+	tapi_stream_recv(&coder->vmmc->tdev, skb);
+}
+*/
+/*
+int vmmc_coder_set_codec(struct vmmc_coder *coder, enum vmmc_codec codec)
+{
+}*/
+
+void vmmc_init_coders(struct vmmc *vmmc)
+{
+	unsigned int i;
+
+	payload_enc[0] = 0;
+	payload_enc[1] = 0x0;
+	payload_enc[1] |= vmmc_coder_payload_mapping[2] << 8;
+	payload_enc[1] |= vmmc_coder_payload_mapping[3] << 8;
+	for (i = 2; i < 9; ++i) {
+		payload_enc[i] = vmmc_coder_payload_mapping[i*4 - 4] << 24;
+		payload_enc[i] |= vmmc_coder_payload_mapping[i*4 - 3] << 16;
+		payload_enc[i] |= vmmc_coder_payload_mapping[i*4 - 2] << 8;
+		payload_enc[i] |= vmmc_coder_payload_mapping[i*4 - 1];
+		payload_enc[i] |= 0x80808080;
+	}
+	for (i = 0; i < 7; ++i) {
+		payload_dec[i] = vmmc_coder_payload_mapping[i*4 + 2] << 24;
+		payload_dec[i] |= vmmc_coder_payload_mapping[i*4 + 3] << 16;
+		payload_dec[i] |= vmmc_coder_payload_mapping[i*4 + 4] << 8;
+		payload_dec[i] |= vmmc_coder_payload_mapping[i*4 + 5];
+	}
+	payload_dec[i] = vmmc_coder_payload_mapping[i*4 + 2] << 24;
+	payload_dec[i] |= vmmc_coder_payload_mapping[i*4 + 3] << 16;
+
+
+	vmmc->num_coders = 5;
+	vmmc->coder = kcalloc(sizeof(*vmmc->coder), vmmc->num_coders, GFP_KERNEL);
+
+	for (i = 0; i < vmmc->num_coders; ++i)
+		vmmc_coder_init(&vmmc->coder[i], vmmc, i);
+}
+
+struct vmmc_coder *vmmc_coder_get(struct vmmc *vmmc)
+{
+	unsigned int i;
+	for (i = 0; i < vmmc->num_coders; ++i) {
+		if (!test_and_set_bit(i, &vmmc->coder_used))
+			return &vmmc->coder[i];
+	}
+
+	return NULL;
+}
+
+void vmmc_coder_put(struct vmmc *vmmc, struct vmmc_coder *coder)
+{
+	clear_bit(coder->id, &vmmc->coder_used);
+}