Linux-2.6.12-rc2
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / w1 / dscore.c
blobeee6644d33d6e60ee89e5eb0cffe8e84ae6c9d38
1 /*
2 * dscore.c
4 * Copyright (c) 2004 Evgeniy Polyakov <johnpol@2ka.mipt.ru>
5 *
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/module.h>
23 #include <linux/kernel.h>
24 #include <linux/mod_devicetable.h>
25 #include <linux/usb.h>
27 #include "dscore.h"
29 static struct usb_device_id ds_id_table [] = {
30 { USB_DEVICE(0x04fa, 0x2490) },
31 { },
33 MODULE_DEVICE_TABLE(usb, ds_id_table);
35 int ds_probe(struct usb_interface *, const struct usb_device_id *);
36 void ds_disconnect(struct usb_interface *);
38 int ds_touch_bit(struct ds_device *, u8, u8 *);
39 int ds_read_byte(struct ds_device *, u8 *);
40 int ds_read_bit(struct ds_device *, u8 *);
41 int ds_write_byte(struct ds_device *, u8);
42 int ds_write_bit(struct ds_device *, u8);
43 int ds_start_pulse(struct ds_device *, int);
44 int ds_set_speed(struct ds_device *, int);
45 int ds_reset(struct ds_device *, struct ds_status *);
46 int ds_detect(struct ds_device *, struct ds_status *);
47 int ds_stop_pulse(struct ds_device *, int);
48 struct ds_device * ds_get_device(void);
49 void ds_put_device(struct ds_device *);
51 static inline void ds_dump_status(unsigned char *, unsigned char *, int);
52 static int ds_send_control(struct ds_device *, u16, u16);
53 static int ds_send_control_mode(struct ds_device *, u16, u16);
54 static int ds_send_control_cmd(struct ds_device *, u16, u16);
57 static struct usb_driver ds_driver = {
58 .owner = THIS_MODULE,
59 .name = "DS9490R",
60 .probe = ds_probe,
61 .disconnect = ds_disconnect,
62 .id_table = ds_id_table,
65 static struct ds_device *ds_dev;
67 struct ds_device * ds_get_device(void)
69 if (ds_dev)
70 atomic_inc(&ds_dev->refcnt);
71 return ds_dev;
74 void ds_put_device(struct ds_device *dev)
76 atomic_dec(&dev->refcnt);
79 static int ds_send_control_cmd(struct ds_device *dev, u16 value, u16 index)
81 int err;
83 err = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, dev->ep[EP_CONTROL]),
84 CONTROL_CMD, 0x40, value, index, NULL, 0, 1000);
85 if (err < 0) {
86 printk(KERN_ERR "Failed to send command control message %x.%x: err=%d.\n",
87 value, index, err);
88 return err;
91 return err;
94 static int ds_send_control_mode(struct ds_device *dev, u16 value, u16 index)
96 int err;
98 err = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, dev->ep[EP_CONTROL]),
99 MODE_CMD, 0x40, value, index, NULL, 0, 1000);
100 if (err < 0) {
101 printk(KERN_ERR "Failed to send mode control message %x.%x: err=%d.\n",
102 value, index, err);
103 return err;
106 return err;
109 static int ds_send_control(struct ds_device *dev, u16 value, u16 index)
111 int err;
113 err = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, dev->ep[EP_CONTROL]),
114 COMM_CMD, 0x40, value, index, NULL, 0, 1000);
115 if (err < 0) {
116 printk(KERN_ERR "Failed to send control message %x.%x: err=%d.\n",
117 value, index, err);
118 return err;
121 return err;
124 static inline void ds_dump_status(unsigned char *buf, unsigned char *str, int off)
126 printk("%45s: %8x\n", str, buf[off]);
129 int ds_recv_status_nodump(struct ds_device *dev, struct ds_status *st, unsigned char *buf, int size)
131 int count, err;
133 memset(st, 0, sizeof(st));
135 count = 0;
136 err = usb_bulk_msg(dev->udev, usb_rcvbulkpipe(dev->udev, dev->ep[EP_STATUS]), buf, size, &count, 100);
137 if (err < 0) {
138 printk(KERN_ERR "Failed to read 1-wire data from 0x%x: err=%d.\n", dev->ep[EP_STATUS], err);
139 return err;
142 if (count >= sizeof(*st))
143 memcpy(st, buf, sizeof(*st));
145 return count;
148 static int ds_recv_status(struct ds_device *dev, struct ds_status *st)
150 unsigned char buf[64];
151 int count, err = 0, i;
153 memcpy(st, buf, sizeof(*st));
155 count = ds_recv_status_nodump(dev, st, buf, sizeof(buf));
156 if (count < 0)
157 return err;
159 printk("0x%x: count=%d, status: ", dev->ep[EP_STATUS], count);
160 for (i=0; i<count; ++i)
161 printk("%02x ", buf[i]);
162 printk("\n");
164 if (count >= 16) {
165 ds_dump_status(buf, "enable flag", 0);
166 ds_dump_status(buf, "1-wire speed", 1);
167 ds_dump_status(buf, "strong pullup duration", 2);
168 ds_dump_status(buf, "programming pulse duration", 3);
169 ds_dump_status(buf, "pulldown slew rate control", 4);
170 ds_dump_status(buf, "write-1 low time", 5);
171 ds_dump_status(buf, "data sample offset/write-0 recovery time", 6);
172 ds_dump_status(buf, "reserved (test register)", 7);
173 ds_dump_status(buf, "device status flags", 8);
174 ds_dump_status(buf, "communication command byte 1", 9);
175 ds_dump_status(buf, "communication command byte 2", 10);
176 ds_dump_status(buf, "communication command buffer status", 11);
177 ds_dump_status(buf, "1-wire data output buffer status", 12);
178 ds_dump_status(buf, "1-wire data input buffer status", 13);
179 ds_dump_status(buf, "reserved", 14);
180 ds_dump_status(buf, "reserved", 15);
183 memcpy(st, buf, sizeof(*st));
185 if (st->status & ST_EPOF) {
186 printk(KERN_INFO "Resetting device after ST_EPOF.\n");
187 err = ds_send_control_cmd(dev, CTL_RESET_DEVICE, 0);
188 if (err)
189 return err;
190 count = ds_recv_status_nodump(dev, st, buf, sizeof(buf));
191 if (count < 0)
192 return err;
194 #if 0
195 if (st->status & ST_IDLE) {
196 printk(KERN_INFO "Resetting pulse after ST_IDLE.\n");
197 err = ds_start_pulse(dev, PULLUP_PULSE_DURATION);
198 if (err)
199 return err;
201 #endif
203 return err;
206 static int ds_recv_data(struct ds_device *dev, unsigned char *buf, int size)
208 int count, err;
209 struct ds_status st;
211 count = 0;
212 err = usb_bulk_msg(dev->udev, usb_rcvbulkpipe(dev->udev, dev->ep[EP_DATA_IN]),
213 buf, size, &count, 1000);
214 if (err < 0) {
215 printk(KERN_INFO "Clearing ep0x%x.\n", dev->ep[EP_DATA_IN]);
216 usb_clear_halt(dev->udev, usb_rcvbulkpipe(dev->udev, dev->ep[EP_DATA_IN]));
217 ds_recv_status(dev, &st);
218 return err;
221 #if 0
223 int i;
225 printk("%s: count=%d: ", __func__, count);
226 for (i=0; i<count; ++i)
227 printk("%02x ", buf[i]);
228 printk("\n");
230 #endif
231 return count;
234 static int ds_send_data(struct ds_device *dev, unsigned char *buf, int len)
236 int count, err;
238 count = 0;
239 err = usb_bulk_msg(dev->udev, usb_sndbulkpipe(dev->udev, dev->ep[EP_DATA_OUT]), buf, len, &count, 1000);
240 if (err < 0) {
241 printk(KERN_ERR "Failed to read 1-wire data from 0x02: err=%d.\n", err);
242 return err;
245 return err;
248 int ds_stop_pulse(struct ds_device *dev, int limit)
250 struct ds_status st;
251 int count = 0, err = 0;
252 u8 buf[0x20];
254 do {
255 err = ds_send_control(dev, CTL_HALT_EXE_IDLE, 0);
256 if (err)
257 break;
258 err = ds_send_control(dev, CTL_RESUME_EXE, 0);
259 if (err)
260 break;
261 err = ds_recv_status_nodump(dev, &st, buf, sizeof(buf));
262 if (err)
263 break;
265 if ((st.status & ST_SPUA) == 0) {
266 err = ds_send_control_mode(dev, MOD_PULSE_EN, 0);
267 if (err)
268 break;
270 } while(++count < limit);
272 return err;
275 int ds_detect(struct ds_device *dev, struct ds_status *st)
277 int err;
279 err = ds_send_control_cmd(dev, CTL_RESET_DEVICE, 0);
280 if (err)
281 return err;
283 err = ds_send_control(dev, COMM_SET_DURATION | COMM_IM, 0);
284 if (err)
285 return err;
287 err = ds_send_control(dev, COMM_SET_DURATION | COMM_IM | COMM_TYPE, 0x40);
288 if (err)
289 return err;
291 err = ds_send_control_mode(dev, MOD_PULSE_EN, PULSE_PROG);
292 if (err)
293 return err;
295 err = ds_recv_status(dev, st);
297 return err;
300 int ds_wait_status(struct ds_device *dev, struct ds_status *st)
302 u8 buf[0x20];
303 int err, count = 0;
305 do {
306 err = ds_recv_status_nodump(dev, st, buf, sizeof(buf));
307 #if 0
308 if (err >= 0) {
309 int i;
310 printk("0x%x: count=%d, status: ", dev->ep[EP_STATUS], err);
311 for (i=0; i<err; ++i)
312 printk("%02x ", buf[i]);
313 printk("\n");
315 #endif
316 } while(!(buf[0x08] & 0x20) && !(err < 0) && ++count < 100);
319 if (((err > 16) && (buf[0x10] & 0x01)) || count >= 100 || err < 0) {
320 ds_recv_status(dev, st);
321 return -1;
323 else {
324 return 0;
328 int ds_reset(struct ds_device *dev, struct ds_status *st)
330 int err;
332 //err = ds_send_control(dev, COMM_1_WIRE_RESET | COMM_F | COMM_IM | COMM_SE, SPEED_FLEXIBLE);
333 err = ds_send_control(dev, 0x43, SPEED_NORMAL);
334 if (err)
335 return err;
337 ds_wait_status(dev, st);
338 #if 0
339 if (st->command_buffer_status) {
340 printk(KERN_INFO "Short circuit.\n");
341 return -EIO;
343 #endif
345 return 0;
348 int ds_set_speed(struct ds_device *dev, int speed)
350 int err;
352 if (speed != SPEED_NORMAL && speed != SPEED_FLEXIBLE && speed != SPEED_OVERDRIVE)
353 return -EINVAL;
355 if (speed != SPEED_OVERDRIVE)
356 speed = SPEED_FLEXIBLE;
358 speed &= 0xff;
360 err = ds_send_control_mode(dev, MOD_1WIRE_SPEED, speed);
361 if (err)
362 return err;
364 return err;
367 int ds_start_pulse(struct ds_device *dev, int delay)
369 int err;
370 u8 del = 1 + (u8)(delay >> 4);
371 struct ds_status st;
373 #if 0
374 err = ds_stop_pulse(dev, 10);
375 if (err)
376 return err;
378 err = ds_send_control_mode(dev, MOD_PULSE_EN, PULSE_SPUE);
379 if (err)
380 return err;
381 #endif
382 err = ds_send_control(dev, COMM_SET_DURATION | COMM_IM, del);
383 if (err)
384 return err;
386 err = ds_send_control(dev, COMM_PULSE | COMM_IM | COMM_F, 0);
387 if (err)
388 return err;
390 mdelay(delay);
392 ds_wait_status(dev, &st);
394 return err;
397 int ds_touch_bit(struct ds_device *dev, u8 bit, u8 *tbit)
399 int err, count;
400 struct ds_status st;
401 u16 value = (COMM_BIT_IO | COMM_IM) | ((bit) ? COMM_D : 0);
402 u16 cmd;
404 err = ds_send_control(dev, value, 0);
405 if (err)
406 return err;
408 count = 0;
409 do {
410 err = ds_wait_status(dev, &st);
411 if (err)
412 return err;
414 cmd = st.command0 | (st.command1 << 8);
415 } while (cmd != value && ++count < 10);
417 if (err < 0 || count >= 10) {
418 printk(KERN_ERR "Failed to obtain status.\n");
419 return -EINVAL;
422 err = ds_recv_data(dev, tbit, sizeof(*tbit));
423 if (err < 0)
424 return err;
426 return 0;
429 int ds_write_bit(struct ds_device *dev, u8 bit)
431 int err;
432 struct ds_status st;
434 err = ds_send_control(dev, COMM_BIT_IO | COMM_IM | (bit) ? COMM_D : 0, 0);
435 if (err)
436 return err;
438 ds_wait_status(dev, &st);
440 return 0;
443 int ds_write_byte(struct ds_device *dev, u8 byte)
445 int err;
446 struct ds_status st;
447 u8 rbyte;
449 err = ds_send_control(dev, COMM_BYTE_IO | COMM_IM | COMM_SPU, byte);
450 if (err)
451 return err;
453 err = ds_wait_status(dev, &st);
454 if (err)
455 return err;
457 err = ds_recv_data(dev, &rbyte, sizeof(rbyte));
458 if (err < 0)
459 return err;
461 ds_start_pulse(dev, PULLUP_PULSE_DURATION);
463 return !(byte == rbyte);
466 int ds_read_bit(struct ds_device *dev, u8 *bit)
468 int err;
470 err = ds_send_control_mode(dev, MOD_PULSE_EN, PULSE_SPUE);
471 if (err)
472 return err;
474 err = ds_send_control(dev, COMM_BIT_IO | COMM_IM | COMM_SPU | COMM_D, 0);
475 if (err)
476 return err;
478 err = ds_recv_data(dev, bit, sizeof(*bit));
479 if (err < 0)
480 return err;
482 return 0;
485 int ds_read_byte(struct ds_device *dev, u8 *byte)
487 int err;
488 struct ds_status st;
490 err = ds_send_control(dev, COMM_BYTE_IO | COMM_IM , 0xff);
491 if (err)
492 return err;
494 ds_wait_status(dev, &st);
496 err = ds_recv_data(dev, byte, sizeof(*byte));
497 if (err < 0)
498 return err;
500 return 0;
503 int ds_read_block(struct ds_device *dev, u8 *buf, int len)
505 struct ds_status st;
506 int err;
508 if (len > 64*1024)
509 return -E2BIG;
511 memset(buf, 0xFF, len);
513 err = ds_send_data(dev, buf, len);
514 if (err < 0)
515 return err;
517 err = ds_send_control(dev, COMM_BLOCK_IO | COMM_IM | COMM_SPU, len);
518 if (err)
519 return err;
521 ds_wait_status(dev, &st);
523 memset(buf, 0x00, len);
524 err = ds_recv_data(dev, buf, len);
526 return err;
529 int ds_write_block(struct ds_device *dev, u8 *buf, int len)
531 int err;
532 struct ds_status st;
534 err = ds_send_data(dev, buf, len);
535 if (err < 0)
536 return err;
538 ds_wait_status(dev, &st);
540 err = ds_send_control(dev, COMM_BLOCK_IO | COMM_IM | COMM_SPU, len);
541 if (err)
542 return err;
544 ds_wait_status(dev, &st);
546 err = ds_recv_data(dev, buf, len);
547 if (err < 0)
548 return err;
550 ds_start_pulse(dev, PULLUP_PULSE_DURATION);
552 return !(err == len);
555 int ds_search(struct ds_device *dev, u64 init, u64 *buf, u8 id_number, int conditional_search)
557 int err;
558 u16 value, index;
559 struct ds_status st;
561 memset(buf, 0, sizeof(buf));
563 err = ds_send_data(ds_dev, (unsigned char *)&init, 8);
564 if (err)
565 return err;
567 ds_wait_status(ds_dev, &st);
569 value = COMM_SEARCH_ACCESS | COMM_IM | COMM_SM | COMM_F | COMM_RTS;
570 index = (conditional_search ? 0xEC : 0xF0) | (id_number << 8);
571 err = ds_send_control(ds_dev, value, index);
572 if (err)
573 return err;
575 ds_wait_status(ds_dev, &st);
577 err = ds_recv_data(ds_dev, (unsigned char *)buf, 8*id_number);
578 if (err < 0)
579 return err;
581 return err/8;
584 int ds_match_access(struct ds_device *dev, u64 init)
586 int err;
587 struct ds_status st;
589 err = ds_send_data(dev, (unsigned char *)&init, sizeof(init));
590 if (err)
591 return err;
593 ds_wait_status(dev, &st);
595 err = ds_send_control(dev, COMM_MATCH_ACCESS | COMM_IM | COMM_RST, 0x0055);
596 if (err)
597 return err;
599 ds_wait_status(dev, &st);
601 return 0;
604 int ds_set_path(struct ds_device *dev, u64 init)
606 int err;
607 struct ds_status st;
608 u8 buf[9];
610 memcpy(buf, &init, 8);
611 buf[8] = BRANCH_MAIN;
613 err = ds_send_data(dev, buf, sizeof(buf));
614 if (err)
615 return err;
617 ds_wait_status(dev, &st);
619 err = ds_send_control(dev, COMM_SET_PATH | COMM_IM | COMM_RST, 0);
620 if (err)
621 return err;
623 ds_wait_status(dev, &st);
625 return 0;
628 int ds_probe(struct usb_interface *intf, const struct usb_device_id *udev_id)
630 struct usb_device *udev = interface_to_usbdev(intf);
631 struct usb_endpoint_descriptor *endpoint;
632 struct usb_host_interface *iface_desc;
633 int i, err;
635 ds_dev = kmalloc(sizeof(struct ds_device), GFP_KERNEL);
636 if (!ds_dev) {
637 printk(KERN_INFO "Failed to allocate new DS9490R structure.\n");
638 return -ENOMEM;
641 ds_dev->udev = usb_get_dev(udev);
642 usb_set_intfdata(intf, ds_dev);
644 err = usb_set_interface(ds_dev->udev, intf->altsetting[0].desc.bInterfaceNumber, 3);
645 if (err) {
646 printk(KERN_ERR "Failed to set alternative setting 3 for %d interface: err=%d.\n",
647 intf->altsetting[0].desc.bInterfaceNumber, err);
648 return err;
651 err = usb_reset_configuration(ds_dev->udev);
652 if (err) {
653 printk(KERN_ERR "Failed to reset configuration: err=%d.\n", err);
654 return err;
657 iface_desc = &intf->altsetting[0];
658 if (iface_desc->desc.bNumEndpoints != NUM_EP-1) {
659 printk(KERN_INFO "Num endpoints=%d. It is not DS9490R.\n", iface_desc->desc.bNumEndpoints);
660 return -ENODEV;
663 atomic_set(&ds_dev->refcnt, 0);
664 memset(ds_dev->ep, 0, sizeof(ds_dev->ep));
667 * This loop doesn'd show control 0 endpoint,
668 * so we will fill only 1-3 endpoints entry.
670 for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
671 endpoint = &iface_desc->endpoint[i].desc;
673 ds_dev->ep[i+1] = endpoint->bEndpointAddress;
675 printk("%d: addr=%x, size=%d, dir=%s, type=%x\n",
676 i, endpoint->bEndpointAddress, le16_to_cpu(endpoint->wMaxPacketSize),
677 (endpoint->bEndpointAddress & USB_DIR_IN)?"IN":"OUT",
678 endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK);
681 #if 0
683 int err, i;
684 u64 buf[3];
685 u64 init=0xb30000002078ee81ull;
686 struct ds_status st;
688 ds_reset(ds_dev, &st);
689 err = ds_search(ds_dev, init, buf, 3, 0);
690 if (err < 0)
691 return err;
692 for (i=0; i<err; ++i)
693 printk("%d: %llx\n", i, buf[i]);
695 printk("Resetting...\n");
696 ds_reset(ds_dev, &st);
697 printk("Setting path for %llx.\n", init);
698 err = ds_set_path(ds_dev, init);
699 if (err)
700 return err;
701 printk("Calling MATCH_ACCESS.\n");
702 err = ds_match_access(ds_dev, init);
703 if (err)
704 return err;
706 printk("Searching the bus...\n");
707 err = ds_search(ds_dev, init, buf, 3, 0);
709 printk("ds_search() returned %d\n", err);
711 if (err < 0)
712 return err;
713 for (i=0; i<err; ++i)
714 printk("%d: %llx\n", i, buf[i]);
716 return 0;
718 #endif
720 return 0;
723 void ds_disconnect(struct usb_interface *intf)
725 struct ds_device *dev;
727 dev = usb_get_intfdata(intf);
728 usb_set_intfdata(intf, NULL);
730 while (atomic_read(&dev->refcnt)) {
731 printk(KERN_INFO "Waiting for DS to become free: refcnt=%d.\n",
732 atomic_read(&dev->refcnt));
734 if (msleep_interruptible(1000))
735 flush_signals(current);
738 usb_put_dev(dev->udev);
739 kfree(dev);
740 ds_dev = NULL;
743 int ds_init(void)
745 int err;
747 err = usb_register(&ds_driver);
748 if (err) {
749 printk(KERN_INFO "Failed to register DS9490R USB device: err=%d.\n", err);
750 return err;
753 return 0;
756 void ds_fini(void)
758 usb_deregister(&ds_driver);
761 module_init(ds_init);
762 module_exit(ds_fini);
764 MODULE_LICENSE("GPL");
765 MODULE_AUTHOR("Evgeniy Polyakov <johnpol@2ka.mipt.ru>");
767 EXPORT_SYMBOL(ds_touch_bit);
768 EXPORT_SYMBOL(ds_read_byte);
769 EXPORT_SYMBOL(ds_read_bit);
770 EXPORT_SYMBOL(ds_read_block);
771 EXPORT_SYMBOL(ds_write_byte);
772 EXPORT_SYMBOL(ds_write_bit);
773 EXPORT_SYMBOL(ds_write_block);
774 EXPORT_SYMBOL(ds_reset);
775 EXPORT_SYMBOL(ds_get_device);
776 EXPORT_SYMBOL(ds_put_device);
779 * This functions can be used for EEPROM programming,
780 * when driver will be included into mainline this will
781 * require uncommenting.
783 #if 0
784 EXPORT_SYMBOL(ds_start_pulse);
785 EXPORT_SYMBOL(ds_set_speed);
786 EXPORT_SYMBOL(ds_detect);
787 EXPORT_SYMBOL(ds_stop_pulse);
788 EXPORT_SYMBOL(ds_search);
789 #endif