aboutsummaryrefslogtreecommitdiff
path: root/drivers/misc/mediatek/dual_ccci/ccmni.c
blob: 0f862ac4d4703d79af50a8d81cd405c1883cd73b (plain) (blame)
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
/*****************************************************************************
 *
 * Filename:
 * ---------
 *   ccmni.c
 *
 * Project:
 * --------
 *   
 *
 * Description:
 * ------------
 *   
 *
 * Author:
 * -------
 *   
 *
 ****************************************************************************/
#include <ccci.h>
extern int  ccmni_v1_init(int md_id);
extern void ccmni_v1_exit(int md_id);
extern int  ccmni_v2_init(int md_id);
extern void ccmni_v2_exit(int md_id);
extern int  ccmni_v1_ipo_h_restore(int md_id);
extern int  ccmni_v2_ipo_h_restore(int md_id);


void *ccmni_ctl_block[MAX_MD_NUM];

static char mac_addr_table[MAX_MD_NUM*5][ETH_ALEN];
static int  mac_addr_num = 0;


int is_mac_addr_duplicate(char *mac)
{
    int i = 0, j;
    int found = 0;
    
    for(i=0; i<mac_addr_num; i++) {
        if( strcmp(mac, mac_addr_table[i]) == 0 ) {
            found = 1;
            return !0;
        }
    }
    if(!found) {
        for(j=0; j<ETH_ALEN; j++)
            mac_addr_table[i][j] = mac[j];
        mac_addr_num++;
        if(mac_addr_num >= (MAX_MD_NUM*5) )
            mac_addr_num--;
    }
    return 0;
}

int ccmni_init(int md_id)
{
    int ccmni_version = 0;
    
    if(ccci_get_sub_module_cfg(md_id, "net", (char*)&ccmni_version, sizeof(int)) != sizeof(int)) {
        CCCI_MSG_INF(md_id, "net", "[Error]get ccmni version fail\n");
        return -1;
    } else {
        CCCI_MSG_INF(md_id, "net", "ccmni driver v%d\n", ccmni_version);
    }
    
    switch(ccmni_version)
    {
        case 1:
            return ccmni_v1_init(md_id);
        case 2:
            return ccmni_v2_init(md_id);
        default:
            CCCI_MSG_INF(md_id, "net", "[Error]invalid CCMNI version: %d\n", ccmni_version);
            return -1;
    }
}


void ccmni_exit(int md_id)
{
    int ccmni_version = 0;
    
    if(ccci_get_sub_module_cfg(md_id, "net", (char*)&ccmni_version, sizeof(int)) != sizeof(int)) {
        CCCI_MSG_INF(md_id, "net", "get ccmni version fail\n");
        return;
    }
    
    switch(ccmni_version)
    {
        case 1:
            return ccmni_v1_exit(md_id);
        case 2:
            return ccmni_v2_exit(md_id);
        default:
            CCCI_MSG_INF(md_id, "net", "[Error]invalid CCMNI version: %d\n", ccmni_version);
            return;
    }
}


int ccmni_ipo_h_restore(int md_id)
{
    int ccmni_version = 0;
    
    if(ccci_get_sub_module_cfg(md_id, "net", (char*)&ccmni_version, sizeof(int)) != sizeof(int)) {
        CCCI_MSG("Get ccmni verion fail\n");
        return -1;
    }
    
    switch(ccmni_version)
    {
        case 1:
            return ccmni_v1_ipo_h_restore(md_id);
        case 2:
            return ccmni_v2_ipo_h_restore(md_id);
        default:
            CCCI_MSG("[Error]CCMNI not support version\n");
            return -1;
    }
}