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
|
/* gsmd vendor plugin core
*
* (C) 2006-2007 by OpenMoko, Inc.
* Written by Harald Welte <laforge@openmoko.org>
* All Rights Reserved
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License along
* with this program; if not, write to the Free Software Foundation, Inc.,
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
*
*/
#include <dlfcn.h>
#include <errno.h>
#include <stdio.h>
#include <string.h>
#include <limits.h>
#include <common/linux_list.h>
#include "gsmd.h"
#include <gsmd/gsmd.h>
#include <gsmd/vendorplugin.h>
static LLIST_HEAD(vendorpl_list);
int gsmd_vendor_plugin_register(struct gsmd_vendor_plugin *pl)
{
llist_add(&pl->list, &vendorpl_list);
return 0;
}
void gsmd_vendor_plugin_unregister(struct gsmd_vendor_plugin *pl)
{
llist_del(&pl->list);
}
int gsmd_vendor_plugin_find(struct gsmd *g)
{
struct gsmd_vendor_plugin *pl;
if (g->vendorpl)
return -EEXIST;
llist_for_each_entry(pl, &vendorpl_list, list) {
if (pl->detect(g) == 1) {
DEBUGP("selecting vendor plugin \"%s\"\n", pl->name);
g->vendorpl = pl;
return 1;
}
}
return 0;
}
int gsmd_vendor_plugin_load(char *name)
{
int rc = -1;
void *lib;
struct gsmd_vendor_plugin *pl;
char buf[PATH_MAX+1];
DEBUGP("loading vendor plugin \"%s\"\n", name);
buf[PATH_MAX] = '\0';
snprintf(buf, sizeof(buf), PLUGINDIR "/libgsmd-vendor_%s.so", name);
lib = dlopen(buf, RTLD_LAZY);
if (!lib) {
fprintf(stderr, "gsmd_vendor_plugin_load: %s\n", dlerror());
return -1;
}
pl = dlsym(lib, "gsmd_vendor_plugin");
if (pl)
rc = gsmd_vendor_plugin_register(pl);
else
dlclose(lib);
return rc;
}
|
