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
|
/* ************************************************************************
* Filename: RTP_parser.c
* Description:
* Version: 1.0
* Created: 04/22/2020 05:09:20 PM
* Revision: none
* Compiler: gcc
* Author: YOUR NAME (),
* Company:
* ************************************************************************/
//#include "drv2624_parser_interfaces.h"
#include "RTP_parser.h"
#include <linux/err.h>
#include <linux/kernel.h>
RTP_info rtp_info;
RTP_head rtp_head;
static void *instruction_end;
int rtp_init(void *file_buf, mod_prof *mod_cfg); //provide file whole buf, get mode configrations
int rtp_eff_open(int ID);
int rtp_eff_get_duration(int ID, unsigned int *dur);
int rtp_eff_get_cfg(int ID, wav_prof *wav_cfg);
int rtp_eff_read(int ID, wav_frame * frame); //one frame/read, return error at wav end
int rtp_eff_close(int ID);
int rtp_eff_get_length(int ID, unsigned int *dur);
void Add_RTP_parser(parser_interfaces * fun_inf)
{
fun_inf->init =rtp_init;
fun_inf->eff_open =rtp_eff_open;
fun_inf->eff_get_duration =rtp_eff_get_duration;
fun_inf->eff_get_cfg =rtp_eff_get_cfg;
fun_inf->eff_read =rtp_eff_read;
fun_inf->eff_get_length =rtp_eff_get_length;
}
int rtp_init(void *file_buf, mod_prof *mod_cfg)
{
pr_info("%s:enter!\n", __func__);
rtp_info.rtp_head_inf = file_buf;
mod_cfg->auto_brake = rtp_info.rtp_head_inf->auto_brake;
mod_cfg->auto_brake_standby = rtp_info.rtp_head_inf->auto_brake_standby;
mod_cfg->fb_brake_factor = rtp_info.rtp_head_inf->fb_brake_factor;
mod_cfg->hybrid_loop = rtp_info.rtp_head_inf->hybrid_loop;
mod_cfg->overDrive_Voltage = rtp_info.rtp_head_inf->overDrive_Voltage;
mod_cfg->rated_Voltage = rtp_info.rtp_head_inf->rated_Voltage;
mod_cfg->F0 = rtp_info.rtp_head_inf->F0;
rtp_head.wav_number = rtp_info.rtp_head_inf->wav_number;
rtp_info.eff_inf_lst = file_buf + sizeof(RTP_head);
pr_info("%s:head size = %ld\n", __func__, sizeof(RTP_head));
pr_info("%s: wav number = %d\n", __func__, rtp_info.rtp_head_inf->wav_number);
pr_info("%s: length = %d\n", __func__, rtp_info.eff_inf_lst[0].length);
pr_info("%s: duration = %d\n", __func__, rtp_info.eff_inf_lst[0].duration);
pr_info("%s: offset = %d\n", __func__, rtp_info.eff_inf_lst[0].offset);
pr_info("%s:auto_brake = %d\n", __func__, mod_cfg->auto_brake);
pr_info("%s:mod_cfg->auto_brake_standby = %d\n", __func__, mod_cfg->auto_brake_standby);
pr_info("%s:mod_cfg->fb_brake_factor = %d\n", __func__, mod_cfg->fb_brake_factor);
pr_info("%s:mod_cfg->hybrid_loop = %d\n", __func__, mod_cfg->hybrid_loop);
pr_info("%s:mod_cfg->F0 = %d\n", __func__, mod_cfg->F0);
pr_info("%s:mod_cfg->rated_Voltage = %d\n", __func__, mod_cfg->rated_Voltage);
pr_info("%s:mod_cfg->overDrive_Voltage = %d\n", __func__, mod_cfg->overDrive_Voltage);
return 0;
}
int rtp_eff_open(int ID)
{
pr_info("%s:enter!\n", __func__);
if(rtp_info.eff_inf_lst[ID].length == 0) {
return DRV_PARSER_ERR_READ_OVER;
}
rtp_info.running_eff.eff_id_open = ID;
rtp_info.running_eff.pPair = (void *)(rtp_info.rtp_head_inf) + rtp_info.eff_inf_lst[ID].offset;
instruction_end = (void *)(rtp_info.rtp_head_inf) + rtp_info.eff_inf_lst[ID].offset + rtp_info.eff_inf_lst[ID].length*2;
return SUCCESS;
}
int rtp_eff_get_duration(int ID, unsigned int *dur)
{
pr_info("%s:enter!\n", __func__);
if (ID != rtp_info.running_eff.eff_id_open)
return DRV_PARSER_ERR_NOTOPEN;
*dur = rtp_info.eff_inf_lst[ID].duration;
return SUCCESS;
}
int rtp_eff_get_length(int ID, unsigned int *dur)
{
pr_info("%s:enter!\n", __func__);
if (ID != rtp_info.running_eff.eff_id_open)
return DRV_PARSER_ERR_NOTOPEN;
*dur = rtp_info.eff_inf_lst[ID].length;
return 0;
}
int rtp_eff_get_cfg(int ID, wav_prof *wav_cfg)
{
pr_info("%s:enter!\n", __func__);
if (ID != rtp_info.running_eff.eff_id_open)
return DRV_PARSER_ERR_NOTOPEN;
wav_cfg->shape = rtp_info.eff_inf_lst[ID].shape;
wav_cfg->loop_mod = rtp_info.eff_inf_lst[ID].loop_mod;
wav_cfg->braking = rtp_info.eff_inf_lst[ID].brake;
pr_info("%s: shape:%d , loop_mod=%d, braking=%d\n", __func__, wav_cfg->shape, wav_cfg->loop_mod, wav_cfg->braking);
return SUCCESS;
}
int rtp_eff_read(int ID, wav_frame *frame)
{
pr_info("%s:enter!\n", __func__);
if (ID != rtp_info.running_eff.eff_id_open)
return DRV_PARSER_ERR_NOTOPEN;
if((void *)rtp_info.running_eff.pPair >= instruction_end)
return DRV_PARSER_ERR_READ_OVER;
*frame = *rtp_info.running_eff.pPair;//
rtp_info.running_eff.pPair++;
return SUCCESS;
}//one frame/read, return error at wav end
|
