4 * Copyright (c) 2003 Evgeniy Polyakov <johnpol@2ka.mipt.ru>
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
22 #include <linux/skbuff.h>
23 #include <linux/netlink.h>
24 #include <linux/connector.h>
28 #include "w1_netlink.h"
30 #if defined(CONFIG_W1_CON) && (defined(CONFIG_CONNECTOR) || (defined(CONFIG_CONNECTOR_MODULE) && defined(CONFIG_W1_MODULE)))
31 void w1_netlink_send(struct w1_master
*dev
, struct w1_netlink_msg
*msg
)
33 char buf
[sizeof(struct cn_msg
) + sizeof(struct w1_netlink_msg
)];
34 struct cn_msg
*m
= (struct cn_msg
*)buf
;
35 struct w1_netlink_msg
*w
= (struct w1_netlink_msg
*)(m
+1);
37 memset(buf
, 0, sizeof(buf
));
39 m
->id
.idx
= CN_W1_IDX
;
40 m
->id
.val
= CN_W1_VAL
;
43 m
->len
= sizeof(struct w1_netlink_msg
);
45 memcpy(w
, msg
, sizeof(struct w1_netlink_msg
));
47 cn_netlink_send(m
, 0, GFP_KERNEL
);
50 static void w1_send_slave(struct w1_master
*dev
, u64 rn
)
52 struct cn_msg
*msg
= dev
->priv
;
53 struct w1_netlink_msg
*hdr
= (struct w1_netlink_msg
*)(msg
+ 1);
54 struct w1_netlink_cmd
*cmd
= (struct w1_netlink_cmd
*)(hdr
+ 1);
57 avail
= dev
->priv_size
- cmd
->len
;
60 u64
*data
= (void *)(cmd
+ 1) + cmd
->len
;
70 cn_netlink_send(msg
, 0, GFP_KERNEL
);
72 msg
->len
= sizeof(struct w1_netlink_msg
) + sizeof(struct w1_netlink_cmd
);
73 hdr
->len
= sizeof(struct w1_netlink_cmd
);
77 static int w1_process_search_command(struct w1_master
*dev
, struct cn_msg
*msg
,
80 struct w1_netlink_msg
*hdr
= (struct w1_netlink_msg
*)(msg
+ 1);
81 struct w1_netlink_cmd
*cmd
= (struct w1_netlink_cmd
*)(hdr
+ 1);
82 int search_type
= (cmd
->cmd
== W1_CMD_ALARM_SEARCH
)?W1_ALARM_SEARCH
:W1_SEARCH
;
85 dev
->priv_size
= avail
;
87 w1_search_devices(dev
, search_type
, w1_send_slave
);
90 cn_netlink_send(msg
, 0, GFP_KERNEL
);
98 static int w1_send_read_reply(struct cn_msg
*msg
, struct w1_netlink_msg
*hdr
,
99 struct w1_netlink_cmd
*cmd
)
102 struct w1_netlink_msg
*h
;
103 struct w1_netlink_cmd
*c
;
107 data
= kzalloc(sizeof(struct cn_msg
) +
108 sizeof(struct w1_netlink_msg
) +
109 sizeof(struct w1_netlink_cmd
) +
110 cmd
->len
, GFP_KERNEL
);
114 cm
= (struct cn_msg
*)(data
);
115 h
= (struct w1_netlink_msg
*)(cm
+ 1);
116 c
= (struct w1_netlink_cmd
*)(h
+ 1);
118 memcpy(cm
, msg
, sizeof(struct cn_msg
));
119 memcpy(h
, hdr
, sizeof(struct w1_netlink_msg
));
120 memcpy(c
, cmd
, sizeof(struct w1_netlink_cmd
));
122 cm
->ack
= msg
->seq
+1;
123 cm
->len
= sizeof(struct w1_netlink_msg
) +
124 sizeof(struct w1_netlink_cmd
) + cmd
->len
;
126 h
->len
= sizeof(struct w1_netlink_cmd
) + cmd
->len
;
128 memcpy(c
->data
, cmd
->data
, c
->len
);
130 err
= cn_netlink_send(cm
, 0, GFP_KERNEL
);
137 static int w1_process_command_io(struct w1_master
*dev
, struct cn_msg
*msg
,
138 struct w1_netlink_msg
*hdr
, struct w1_netlink_cmd
*cmd
)
144 w1_touch_block(dev
, cmd
->data
, cmd
->len
);
145 w1_send_read_reply(msg
, hdr
, cmd
);
148 w1_read_block(dev
, cmd
->data
, cmd
->len
);
149 w1_send_read_reply(msg
, hdr
, cmd
);
152 w1_write_block(dev
, cmd
->data
, cmd
->len
);
162 static int w1_process_command_master(struct w1_master
*dev
, struct cn_msg
*req_msg
,
163 struct w1_netlink_msg
*req_hdr
, struct w1_netlink_cmd
*req_cmd
)
167 struct w1_netlink_msg
*hdr
;
168 struct w1_netlink_cmd
*cmd
;
170 msg
= kzalloc(PAGE_SIZE
, GFP_KERNEL
);
174 msg
->id
= req_msg
->id
;
175 msg
->seq
= req_msg
->seq
;
177 msg
->len
= sizeof(struct w1_netlink_msg
) + sizeof(struct w1_netlink_cmd
);
179 hdr
= (struct w1_netlink_msg
*)(msg
+ 1);
180 cmd
= (struct w1_netlink_cmd
*)(hdr
+ 1);
182 hdr
->type
= W1_MASTER_CMD
;
183 hdr
->id
= req_hdr
->id
;
184 hdr
->len
= sizeof(struct w1_netlink_cmd
);
186 cmd
->cmd
= req_cmd
->cmd
;
191 case W1_CMD_ALARM_SEARCH
:
192 err
= w1_process_search_command(dev
, msg
,
193 PAGE_SIZE
- msg
->len
- sizeof(struct cn_msg
));
198 err
= w1_process_command_io(dev
, req_msg
, req_hdr
, req_cmd
);
201 err
= w1_reset_bus(dev
);
212 static int w1_process_command_slave(struct w1_slave
*sl
, struct cn_msg
*msg
,
213 struct w1_netlink_msg
*hdr
, struct w1_netlink_cmd
*cmd
)
215 dev_dbg(&sl
->master
->dev
, "%s: %02x.%012llx.%02x: cmd=%02x, len=%u.\n",
216 __func__
, sl
->reg_num
.family
, (unsigned long long)sl
->reg_num
.id
,
217 sl
->reg_num
.crc
, cmd
->cmd
, cmd
->len
);
219 return w1_process_command_io(sl
->master
, msg
, hdr
, cmd
);
222 static int w1_process_command_root(struct cn_msg
*msg
, struct w1_netlink_msg
*mcmd
)
226 struct w1_netlink_msg
*w
;
229 if (mcmd
->type
!= W1_LIST_MASTERS
) {
230 printk(KERN_NOTICE
"%s: msg: %x.%x, wrong type: %u, len: %u.\n",
231 __func__
, msg
->id
.idx
, msg
->id
.val
, mcmd
->type
, mcmd
->len
);
235 cn
= kmalloc(PAGE_SIZE
, GFP_KERNEL
);
239 cn
->id
.idx
= CN_W1_IDX
;
240 cn
->id
.val
= CN_W1_VAL
;
244 cn
->len
= sizeof(struct w1_netlink_msg
);
245 w
= (struct w1_netlink_msg
*)(cn
+ 1);
247 w
->type
= W1_LIST_MASTERS
;
252 mutex_lock(&w1_mlock
);
253 list_for_each_entry(m
, &w1_masters
, w1_master_entry
) {
254 if (cn
->len
+ sizeof(*id
) > PAGE_SIZE
- sizeof(struct cn_msg
)) {
255 cn_netlink_send(cn
, 0, GFP_KERNEL
);
257 cn
->len
= sizeof(struct w1_netlink_msg
);
263 w
->len
+= sizeof(*id
);
264 cn
->len
+= sizeof(*id
);
268 cn_netlink_send(cn
, 0, GFP_KERNEL
);
269 mutex_unlock(&w1_mlock
);
275 static int w1_netlink_send_error(struct cn_msg
*rcmsg
, struct w1_netlink_msg
*rmsg
,
276 struct w1_netlink_cmd
*rcmd
, int error
)
279 struct w1_netlink_msg
*msg
;
280 struct w1_netlink_cmd
*cmd
;
282 cmsg
= kzalloc(sizeof(*msg
) + sizeof(*cmd
) + sizeof(*cmsg
), GFP_KERNEL
);
286 msg
= (struct w1_netlink_msg
*)(cmsg
+ 1);
287 cmd
= (struct w1_netlink_cmd
*)(msg
+ 1);
289 memcpy(cmsg
, rcmsg
, sizeof(*cmsg
));
290 cmsg
->len
= sizeof(*msg
);
292 memcpy(msg
, rmsg
, sizeof(*msg
));
294 msg
->status
= (short)-error
;
297 memcpy(cmd
, rcmd
, sizeof(*cmd
));
299 msg
->len
+= sizeof(*cmd
);
300 cmsg
->len
+= sizeof(*cmd
);
303 error
= cn_netlink_send(cmsg
, 0, GFP_KERNEL
);
309 static void w1_cn_callback(void *data
)
311 struct cn_msg
*msg
= data
;
312 struct w1_netlink_msg
*m
= (struct w1_netlink_msg
*)(msg
+ 1);
313 struct w1_netlink_cmd
*cmd
;
315 struct w1_master
*dev
;
318 while (msg
->len
&& !err
) {
319 struct w1_reg_num id
;
321 u8
*cmd_data
= m
->data
;
327 memcpy(&id
, m
->id
.id
, sizeof(id
));
329 printk("%s: %02x.%012llx.%02x: type=%02x, len=%u.\n",
330 __func__
, id
.family
, (unsigned long long)id
.id
, id
.crc
, m
->type
, m
->len
);
332 if (m
->len
+ sizeof(struct w1_netlink_msg
) > msg
->len
) {
337 if (m
->type
== W1_MASTER_CMD
) {
338 dev
= w1_search_master_id(m
->id
.mst
.id
);
339 } else if (m
->type
== W1_SLAVE_CMD
) {
340 sl
= w1_search_slave(&id
);
344 err
= w1_process_command_root(msg
, m
);
357 mutex_lock(&dev
->mutex
);
359 if (sl
&& w1_reset_select_slave(sl
)) {
365 cmd
= (struct w1_netlink_cmd
*)cmd_data
;
367 if (cmd
->len
+ sizeof(struct w1_netlink_cmd
) > mlen
) {
373 err
= w1_process_command_slave(sl
, msg
, m
, cmd
);
375 err
= w1_process_command_master(dev
, msg
, m
, cmd
);
377 w1_netlink_send_error(msg
, m
, cmd
, err
);
380 cmd_data
+= cmd
->len
+ sizeof(struct w1_netlink_cmd
);
381 mlen
-= cmd
->len
+ sizeof(struct w1_netlink_cmd
);
384 atomic_dec(&dev
->refcnt
);
386 atomic_dec(&sl
->refcnt
);
387 mutex_unlock(&dev
->mutex
);
390 w1_netlink_send_error(msg
, m
, cmd
, err
);
391 msg
->len
-= sizeof(struct w1_netlink_msg
) + m
->len
;
392 m
= (struct w1_netlink_msg
*)(((u8
*)m
) + sizeof(struct w1_netlink_msg
) + m
->len
);
395 * Let's allow requests for nonexisting devices.
402 int w1_init_netlink(void)
404 struct cb_id w1_id
= {.idx
= CN_W1_IDX
, .val
= CN_W1_VAL
};
406 return cn_add_callback(&w1_id
, "w1", &w1_cn_callback
);
409 void w1_fini_netlink(void)
411 struct cb_id w1_id
= {.idx
= CN_W1_IDX
, .val
= CN_W1_VAL
};
413 cn_del_callback(&w1_id
);
416 void w1_netlink_send(struct w1_master
*dev
, struct w1_netlink_msg
*msg
)
420 int w1_init_netlink(void)
425 void w1_fini_netlink(void)
This page took 0.039042 seconds and 5 git commands to generate.