File uevent.c copied from file ulinux/types.h (similarity 68%) (mode: 100644) (index 12df4cb..12ec719) |
1 |
|
#ifndef ULINUX_TYPES_H |
|
2 |
|
#define ULINUX_TYPES_H |
|
3 |
1 |
//****************************************************************************** |
//****************************************************************************** |
4 |
2 |
//*this code is protected by the GNU affero GPLv3 |
//*this code is protected by the GNU affero GPLv3 |
5 |
3 |
//*author:Sylvain BERTRAND <sylvain.bertrand AT gmail dot com> |
//*author:Sylvain BERTRAND <sylvain.bertrand AT gmail dot com> |
6 |
4 |
//* <digital.ragnarok AT gmail dot com> |
//* <digital.ragnarok AT gmail dot com> |
7 |
5 |
//****************************************************************************** |
//****************************************************************************** |
8 |
|
#include <ulinux/arch/types.h> |
|
9 |
|
#endif |
|
|
6 |
|
#include <ulinux/compiler_types.h> |
|
7 |
|
#include <ulinux/types.h> |
10 |
8 |
|
|
|
9 |
|
#include "globals.h" |
|
10 |
|
|
|
11 |
|
void uevent_process(k_u8 *p,k_i sz) |
|
12 |
|
{ |
|
13 |
|
while(sz){ |
|
14 |
|
++p; |
|
15 |
|
sz--; |
|
16 |
|
} |
|
17 |
|
} |
File uevents.c changed (mode: 100644) (index c7ab039..1684f9b) |
23 |
23 |
#endif |
#endif |
24 |
24 |
|
|
25 |
25 |
#include "globals.h" |
#include "globals.h" |
26 |
|
static k_i ep_fd=-1; |
|
27 |
|
static k_i s=-1; |
|
|
26 |
|
#include "uevent.h" |
|
27 |
|
static k_i ep_fd; |
|
28 |
|
static k_i s; |
28 |
29 |
|
|
29 |
30 |
void uevents_setup(void) |
void uevents_setup(void) |
30 |
31 |
{ |
{ |
|
... |
... |
void uevents_setup(void) |
37 |
38 |
|
|
38 |
39 |
//---------------------------------------------------------------------------- |
//---------------------------------------------------------------------------- |
39 |
40 |
|
|
40 |
|
s=(k_i)sysc(socket,3,K_PF_NETLINK,K_SOCK_RAW|K_SOCK_NONBLOCK, |
|
41 |
|
K_NETLINK_KOBJECT_UEVENT); |
|
|
41 |
|
//blocking socket |
|
42 |
|
s=(k_i)sysc(socket,3,K_PF_NETLINK,K_SOCK_RAW,K_NETLINK_KOBJECT_UEVENT); |
42 |
43 |
if(K_ISERR(s)){ |
if(K_ISERR(s)){ |
43 |
44 |
OUT("ERROR(%d):unable to create uevent netlink socket\n",s); |
OUT("ERROR(%d):unable to create uevent netlink socket\n",s); |
44 |
45 |
sysc(exit_group,1,-1); |
sysc(exit_group,1,-1); |
|
... |
... |
void uevents_setup(void) |
56 |
57 |
|
|
57 |
58 |
//---------------------------------------------------------------------------- |
//---------------------------------------------------------------------------- |
58 |
59 |
|
|
59 |
|
//uevent groups? only one: 1 |
|
|
60 |
|
//uevent groups-->only one: 1 |
60 |
61 |
struct k_sockaddr_nl addr={K_AF_NETLINK,0,0,1}; |
struct k_sockaddr_nl addr={K_AF_NETLINK,0,0,1}; |
61 |
62 |
r=sysc(bind,3,s,&addr,sizeof(addr)); |
r=sysc(bind,3,s,&addr,sizeof(addr)); |
62 |
63 |
if(K_ISERR(r)){ |
if(K_ISERR(r)){ |
|
... |
... |
void uevents_setup(void) |
78 |
79 |
OUTC("done\n"); |
OUTC("done\n"); |
79 |
80 |
} |
} |
80 |
81 |
|
|
81 |
|
static void uevent_msg(k_i s) |
|
|
82 |
|
static void uevent_msg(void) |
82 |
83 |
{ |
{ |
83 |
|
k_u8 buf[8192]; |
|
|
84 |
|
k_u8 buf[8192];//presume 8kB is enough for one message |
84 |
85 |
u_memset(buf,0,sizeof(buf)); |
u_memset(buf,0,sizeof(buf)); |
85 |
86 |
|
|
86 |
87 |
struct k_io_vec io_vec; |
struct k_io_vec io_vec; |
|
... |
... |
static void uevent_msg(k_i s) |
104 |
105 |
OUT("ERROR:the uevent was truncated(flags=0x%x)\n",msg.flgs); |
OUT("ERROR:the uevent was truncated(flags=0x%x)\n",msg.flgs); |
105 |
106 |
sysc(exit_group,1,-1); |
sysc(exit_group,1,-1); |
106 |
107 |
} |
} |
107 |
|
OUTC("uevent received:\n"); |
|
108 |
|
k_i len=r; |
|
109 |
|
k_u8 *p=&buf[0]; |
|
110 |
|
while(len){ |
|
111 |
|
if(*p) OUT("%c",*p); else OUTC("\n"); |
|
112 |
|
++p; |
|
113 |
|
len--; |
|
114 |
|
} |
|
115 |
|
OUTC("\n"); |
|
|
108 |
|
uevent_process(&buf[0],(k_i)r); |
116 |
109 |
} |
} |
117 |
110 |
|
|
118 |
111 |
void uevents_process(void) |
void uevents_process(void) |
|
... |
... |
void uevents_process(void) |
120 |
113 |
OUTC(PRE "processing uevents...\n"); |
OUTC(PRE "processing uevents...\n"); |
121 |
114 |
while(1){ |
while(1){ |
122 |
115 |
k_l r; |
k_l r; |
123 |
|
static struct k_epoll_event evts[1];//uevent netlink event |
|
|
116 |
|
static struct k_epoll_event evts;//uevent netlink event |
124 |
117 |
do{ |
do{ |
125 |
|
u_memset(evts,0,sizeof(evts)); |
|
126 |
|
r=sysc(epoll_wait,4,ep_fd,evts,1,-1); |
|
|
118 |
|
u_memset(&evts,0,sizeof(evts)); |
|
119 |
|
r=sysc(epoll_wait,4,ep_fd,&evts,1,-1); |
127 |
120 |
}while(r==-K_EINTR); |
}while(r==-K_EINTR); |
128 |
121 |
if(K_ISERR(r)){ |
if(K_ISERR(r)){ |
129 |
|
OUT(PRE "ERROR:error epolling fds (%ld)\n",r); |
|
|
122 |
|
OUT(PRE "ERROR(%ld):error epolling uevent netlink socket\n",r); |
130 |
123 |
sysc(exit_group,1,-1); |
sysc(exit_group,1,-1); |
131 |
124 |
} |
} |
132 |
|
k_l i=0; |
|
133 |
|
while(i<r){ |
|
134 |
|
if(evts[i].data.fd==s){ |
|
135 |
|
if(evts[i].events&K_EPOLLIN){ |
|
136 |
|
uevent_msg(s); |
|
137 |
|
}else{ |
|
138 |
|
OUT(PRE "ERROR:unmanaged epolling event on uevent netlink socket" |
|
139 |
|
" n=%ld events=%u\n", i,evts[i].events); |
|
140 |
|
sysc(exit_group,1,-1); |
|
141 |
|
} |
|
142 |
|
} |
|
143 |
|
++i; |
|
|
125 |
|
if(!r) break;//assume no more uevents |
|
126 |
|
if(evts.events&K_EPOLLIN) uevent_msg(); |
|
127 |
|
else{ |
|
128 |
|
OUT(PRE "ERROR:unmanaged epolling event on uevent netlink socket" |
|
129 |
|
"(events=%u)\n",evts.events); |
|
130 |
|
sysc(exit_group,1,-1); |
144 |
131 |
} |
} |
145 |
132 |
} |
} |
|
133 |
|
OUTC(PRE "uevents processed\n"); |
146 |
134 |
} |
} |