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
, msg
, hdr
, cmd
);
202 cn_netlink_send(msg
, 0, GFP_KERNEL
);
210 static int w1_process_command_slave(struct w1_slave
*sl
, struct cn_msg
*msg
,
211 struct w1_netlink_msg
*hdr
, struct w1_netlink_cmd
*cmd
)
213 dev_dbg(&sl
->master
->dev
, "%s: %02x.%012llx.%02x: cmd=%02x, len=%u.\n",
214 __func__
, sl
->reg_num
.family
, (unsigned long long)sl
->reg_num
.id
,
215 sl
->reg_num
.crc
, cmd
->cmd
, cmd
->len
);
217 return w1_process_command_io(sl
->master
, msg
, hdr
, cmd
);
220 static int w1_process_command_root(struct cn_msg
*msg
, struct w1_netlink_msg
*mcmd
)
224 struct w1_netlink_msg
*w
;
227 if (mcmd
->type
!= W1_LIST_MASTERS
) {
228 printk(KERN_NOTICE
"%s: msg: %x.%x, wrong type: %u, len: %u.\n",
229 __func__
, msg
->id
.idx
, msg
->id
.val
, mcmd
->type
, mcmd
->len
);
233 cn
= kmalloc(PAGE_SIZE
, GFP_KERNEL
);
237 cn
->id
.idx
= CN_W1_IDX
;
238 cn
->id
.val
= CN_W1_VAL
;
242 cn
->len
= sizeof(struct w1_netlink_msg
);
243 w
= (struct w1_netlink_msg
*)(cn
+ 1);
245 w
->type
= W1_LIST_MASTERS
;
250 mutex_lock(&w1_mlock
);
251 list_for_each_entry(m
, &w1_masters
, w1_master_entry
) {
252 if (cn
->len
+ sizeof(*id
) > PAGE_SIZE
- sizeof(struct cn_msg
)) {
253 cn_netlink_send(cn
, 0, GFP_KERNEL
);
255 cn
->len
= sizeof(struct w1_netlink_msg
);
261 w
->len
+= sizeof(*id
);
262 cn
->len
+= sizeof(*id
);
266 cn_netlink_send(cn
, 0, GFP_KERNEL
);
267 mutex_unlock(&w1_mlock
);
273 static void w1_cn_callback(void *data
)
275 struct cn_msg
*msg
= data
;
276 struct w1_netlink_msg
*m
= (struct w1_netlink_msg
*)(msg
+ 1);
277 struct w1_netlink_cmd
*cmd
;
279 struct w1_master
*dev
;
282 while (msg
->len
&& !err
) {
283 struct w1_reg_num id
;
285 u8
*cmd_data
= m
->data
;
290 memcpy(&id
, m
->id
.id
, sizeof(id
));
292 printk("%s: %02x.%012llx.%02x: type=%02x, len=%u.\n",
293 __func__
, id
.family
, (unsigned long long)id
.id
, id
.crc
, m
->type
, m
->len
);
295 if (m
->len
+ sizeof(struct w1_netlink_msg
) > msg
->len
) {
300 if (m
->type
== W1_MASTER_CMD
) {
301 dev
= w1_search_master_id(m
->id
.mst
.id
);
302 } else if (m
->type
== W1_SLAVE_CMD
) {
303 sl
= w1_search_slave(&id
);
307 err
= w1_process_command_root(msg
, m
);
320 mutex_lock(&dev
->mutex
);
322 if (sl
&& w1_reset_select_slave(sl
)) {
328 cmd
= (struct w1_netlink_cmd
*)cmd_data
;
330 if (cmd
->len
+ sizeof(struct w1_netlink_cmd
) > mlen
) {
336 w1_process_command_slave(sl
, msg
, m
, cmd
);
338 w1_process_command_master(dev
, msg
, m
, cmd
);
340 cmd_data
+= cmd
->len
+ sizeof(struct w1_netlink_cmd
);
341 mlen
-= cmd
->len
+ sizeof(struct w1_netlink_cmd
);
344 atomic_dec(&dev
->refcnt
);
346 atomic_dec(&sl
->refcnt
);
347 mutex_unlock(&dev
->mutex
);
349 msg
->len
-= sizeof(struct w1_netlink_msg
) + m
->len
;
350 m
= (struct w1_netlink_msg
*)(((u8
*)m
) + sizeof(struct w1_netlink_msg
) + m
->len
);
353 * Let's allow requests for nonexisting devices.
360 int w1_init_netlink(void)
362 struct cb_id w1_id
= {.idx
= CN_W1_IDX
, .val
= CN_W1_VAL
};
364 return cn_add_callback(&w1_id
, "w1", &w1_cn_callback
);
367 void w1_fini_netlink(void)
369 struct cb_id w1_id
= {.idx
= CN_W1_IDX
, .val
= CN_W1_VAL
};
371 cn_del_callback(&w1_id
);
374 void w1_netlink_send(struct w1_master
*dev
, struct w1_netlink_msg
*msg
)
378 int w1_init_netlink(void)
383 void w1_fini_netlink(void)