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/slab.h>
23 #include <linux/skbuff.h>
24 #include <linux/netlink.h>
25 #include <linux/connector.h>
29 #include "w1_netlink.h"
31 #if defined(CONFIG_W1_CON) && (defined(CONFIG_CONNECTOR) || \
32 (defined(CONFIG_CONNECTOR_MODULE) && defined(CONFIG_W1_MODULE)))
33 void w1_netlink_send(struct w1_master
*dev
, struct w1_netlink_msg
*msg
)
35 char buf
[sizeof(struct cn_msg
) + sizeof(struct w1_netlink_msg
)];
36 struct cn_msg
*m
= (struct cn_msg
*)buf
;
37 struct w1_netlink_msg
*w
= (struct w1_netlink_msg
*)(m
+1);
39 memset(buf
, 0, sizeof(buf
));
41 m
->id
.idx
= CN_W1_IDX
;
42 m
->id
.val
= CN_W1_VAL
;
45 m
->len
= sizeof(struct w1_netlink_msg
);
47 memcpy(w
, msg
, sizeof(struct w1_netlink_msg
));
49 cn_netlink_send(m
, 0, GFP_KERNEL
);
52 static void w1_send_slave(struct w1_master
*dev
, u64 rn
)
54 struct cn_msg
*msg
= dev
->priv
;
55 struct w1_netlink_msg
*hdr
= (struct w1_netlink_msg
*)(msg
+ 1);
56 struct w1_netlink_cmd
*cmd
= (struct w1_netlink_cmd
*)(hdr
+ 1);
59 avail
= dev
->priv_size
- cmd
->len
;
62 u64
*data
= (void *)(cmd
+ 1) + cmd
->len
;
72 cn_netlink_send(msg
, 0, GFP_KERNEL
);
74 msg
->len
= sizeof(struct w1_netlink_msg
) + sizeof(struct w1_netlink_cmd
);
75 hdr
->len
= sizeof(struct w1_netlink_cmd
);
79 static int w1_process_search_command(struct w1_master
*dev
, struct cn_msg
*msg
,
82 struct w1_netlink_msg
*hdr
= (struct w1_netlink_msg
*)(msg
+ 1);
83 struct w1_netlink_cmd
*cmd
= (struct w1_netlink_cmd
*)(hdr
+ 1);
84 int search_type
= (cmd
->cmd
== W1_CMD_ALARM_SEARCH
)?W1_ALARM_SEARCH
:W1_SEARCH
;
87 dev
->priv_size
= avail
;
89 w1_search_devices(dev
, search_type
, w1_send_slave
);
92 cn_netlink_send(msg
, 0, GFP_KERNEL
);
100 static int w1_send_read_reply(struct cn_msg
*msg
, struct w1_netlink_msg
*hdr
,
101 struct w1_netlink_cmd
*cmd
)
104 struct w1_netlink_msg
*h
;
105 struct w1_netlink_cmd
*c
;
109 data
= kzalloc(sizeof(struct cn_msg
) +
110 sizeof(struct w1_netlink_msg
) +
111 sizeof(struct w1_netlink_cmd
) +
112 cmd
->len
, GFP_KERNEL
);
116 cm
= (struct cn_msg
*)(data
);
117 h
= (struct w1_netlink_msg
*)(cm
+ 1);
118 c
= (struct w1_netlink_cmd
*)(h
+ 1);
120 memcpy(cm
, msg
, sizeof(struct cn_msg
));
121 memcpy(h
, hdr
, sizeof(struct w1_netlink_msg
));
122 memcpy(c
, cmd
, sizeof(struct w1_netlink_cmd
));
124 cm
->ack
= msg
->seq
+1;
125 cm
->len
= sizeof(struct w1_netlink_msg
) +
126 sizeof(struct w1_netlink_cmd
) + cmd
->len
;
128 h
->len
= sizeof(struct w1_netlink_cmd
) + cmd
->len
;
130 memcpy(c
->data
, cmd
->data
, c
->len
);
132 err
= cn_netlink_send(cm
, 0, GFP_KERNEL
);
139 static int w1_process_command_io(struct w1_master
*dev
, struct cn_msg
*msg
,
140 struct w1_netlink_msg
*hdr
, struct w1_netlink_cmd
*cmd
)
146 w1_touch_block(dev
, cmd
->data
, cmd
->len
);
147 w1_send_read_reply(msg
, hdr
, cmd
);
150 w1_read_block(dev
, cmd
->data
, cmd
->len
);
151 w1_send_read_reply(msg
, hdr
, cmd
);
154 w1_write_block(dev
, cmd
->data
, cmd
->len
);
164 static int w1_process_command_master(struct w1_master
*dev
, struct cn_msg
*req_msg
,
165 struct w1_netlink_msg
*req_hdr
, struct w1_netlink_cmd
*req_cmd
)
169 struct w1_netlink_msg
*hdr
;
170 struct w1_netlink_cmd
*cmd
;
172 msg
= kzalloc(PAGE_SIZE
, GFP_KERNEL
);
176 msg
->id
= req_msg
->id
;
177 msg
->seq
= req_msg
->seq
;
179 msg
->len
= sizeof(struct w1_netlink_msg
) + sizeof(struct w1_netlink_cmd
);
181 hdr
= (struct w1_netlink_msg
*)(msg
+ 1);
182 cmd
= (struct w1_netlink_cmd
*)(hdr
+ 1);
184 hdr
->type
= W1_MASTER_CMD
;
185 hdr
->id
= req_hdr
->id
;
186 hdr
->len
= sizeof(struct w1_netlink_cmd
);
188 cmd
->cmd
= req_cmd
->cmd
;
193 case W1_CMD_ALARM_SEARCH
:
194 err
= w1_process_search_command(dev
, msg
,
195 PAGE_SIZE
- msg
->len
- sizeof(struct cn_msg
));
200 err
= w1_process_command_io(dev
, req_msg
, req_hdr
, req_cmd
);
203 err
= w1_reset_bus(dev
);
214 static int w1_process_command_slave(struct w1_slave
*sl
, struct cn_msg
*msg
,
215 struct w1_netlink_msg
*hdr
, struct w1_netlink_cmd
*cmd
)
217 dev_dbg(&sl
->master
->dev
, "%s: %02x.%012llx.%02x: cmd=%02x, len=%u.\n",
218 __func__
, sl
->reg_num
.family
, (unsigned long long)sl
->reg_num
.id
,
219 sl
->reg_num
.crc
, cmd
->cmd
, cmd
->len
);
221 return w1_process_command_io(sl
->master
, msg
, hdr
, cmd
);
224 static int w1_process_command_root(struct cn_msg
*msg
, struct w1_netlink_msg
*mcmd
)
228 struct w1_netlink_msg
*w
;
231 if (mcmd
->type
!= W1_LIST_MASTERS
) {
232 printk(KERN_NOTICE
"%s: msg: %x.%x, wrong type: %u, len: %u.\n",
233 __func__
, msg
->id
.idx
, msg
->id
.val
, mcmd
->type
, mcmd
->len
);
237 cn
= kmalloc(PAGE_SIZE
, GFP_KERNEL
);
241 cn
->id
.idx
= CN_W1_IDX
;
242 cn
->id
.val
= CN_W1_VAL
;
246 cn
->len
= sizeof(struct w1_netlink_msg
);
247 w
= (struct w1_netlink_msg
*)(cn
+ 1);
249 w
->type
= W1_LIST_MASTERS
;
254 mutex_lock(&w1_mlock
);
255 list_for_each_entry(m
, &w1_masters
, w1_master_entry
) {
256 if (cn
->len
+ sizeof(*id
) > PAGE_SIZE
- sizeof(struct cn_msg
)) {
257 cn_netlink_send(cn
, 0, GFP_KERNEL
);
259 cn
->len
= sizeof(struct w1_netlink_msg
);
265 w
->len
+= sizeof(*id
);
266 cn
->len
+= sizeof(*id
);
270 cn_netlink_send(cn
, 0, GFP_KERNEL
);
271 mutex_unlock(&w1_mlock
);
277 static int w1_netlink_send_error(struct cn_msg
*rcmsg
, struct w1_netlink_msg
*rmsg
,
278 struct w1_netlink_cmd
*rcmd
, int error
)
281 struct w1_netlink_msg
*msg
;
282 struct w1_netlink_cmd
*cmd
;
284 cmsg
= kzalloc(sizeof(*msg
) + sizeof(*cmd
) + sizeof(*cmsg
), GFP_KERNEL
);
288 msg
= (struct w1_netlink_msg
*)(cmsg
+ 1);
289 cmd
= (struct w1_netlink_cmd
*)(msg
+ 1);
291 memcpy(cmsg
, rcmsg
, sizeof(*cmsg
));
292 cmsg
->len
= sizeof(*msg
);
294 memcpy(msg
, rmsg
, sizeof(*msg
));
296 msg
->status
= (short)-error
;
299 memcpy(cmd
, rcmd
, sizeof(*cmd
));
301 msg
->len
+= sizeof(*cmd
);
302 cmsg
->len
+= sizeof(*cmd
);
305 error
= cn_netlink_send(cmsg
, 0, GFP_KERNEL
);
311 static void w1_cn_callback(struct cn_msg
*msg
, struct netlink_skb_parms
*nsp
)
313 struct w1_netlink_msg
*m
= (struct w1_netlink_msg
*)(msg
+ 1);
314 struct w1_netlink_cmd
*cmd
;
316 struct w1_master
*dev
;
319 while (msg
->len
&& !err
) {
320 struct w1_reg_num id
;
322 u8
*cmd_data
= m
->data
;
328 memcpy(&id
, m
->id
.id
, sizeof(id
));
329 if (m
->len
+ sizeof(struct w1_netlink_msg
) > msg
->len
) {
334 if (m
->type
== W1_MASTER_CMD
) {
335 dev
= w1_search_master_id(m
->id
.mst
.id
);
336 } else if (m
->type
== W1_SLAVE_CMD
) {
337 sl
= w1_search_slave(&id
);
341 err
= w1_process_command_root(msg
, m
);
354 mutex_lock(&dev
->mutex
);
356 if (sl
&& w1_reset_select_slave(sl
)) {
362 cmd
= (struct w1_netlink_cmd
*)cmd_data
;
364 if (cmd
->len
+ sizeof(struct w1_netlink_cmd
) > mlen
) {
370 err
= w1_process_command_slave(sl
, msg
, m
, cmd
);
372 err
= w1_process_command_master(dev
, msg
, m
, cmd
);
374 w1_netlink_send_error(msg
, m
, cmd
, err
);
377 cmd_data
+= cmd
->len
+ sizeof(struct w1_netlink_cmd
);
378 mlen
-= cmd
->len
+ sizeof(struct w1_netlink_cmd
);
381 atomic_dec(&dev
->refcnt
);
383 atomic_dec(&sl
->refcnt
);
384 mutex_unlock(&dev
->mutex
);
387 w1_netlink_send_error(msg
, m
, cmd
, err
);
388 msg
->len
-= sizeof(struct w1_netlink_msg
) + m
->len
;
389 m
= (struct w1_netlink_msg
*)(((u8
*)m
) + sizeof(struct w1_netlink_msg
) + m
->len
);
392 * Let's allow requests for nonexisting devices.
399 int w1_init_netlink(void)
401 struct cb_id w1_id
= {.idx
= CN_W1_IDX
, .val
= CN_W1_VAL
};
403 return cn_add_callback(&w1_id
, "w1", &w1_cn_callback
);
406 void w1_fini_netlink(void)
408 struct cb_id w1_id
= {.idx
= CN_W1_IDX
, .val
= CN_W1_VAL
};
410 cn_del_callback(&w1_id
);
413 void w1_netlink_send(struct w1_master
*dev
, struct w1_netlink_msg
*msg
)
417 int w1_init_netlink(void)
422 void w1_fini_netlink(void)