1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * copyright (C) 1999/2000 by Henning Zabel <henning@uni-paderborn.de> 4 */ 5 6 7 /* 8 * USB-Kernel Driver for the Mustek MDC800 Digital Camera 9 * (c) 1999/2000 Henning Zabel <henning@uni-paderborn.de> 10 * 11 * 12 * The driver brings the USB functions of the MDC800 to Linux. 13 * To use the Camera you must support the USB Protocol of the camera 14 * to the Kernel Node. 15 * The Driver uses a misc device Node. Create it with : 16 * mknod /dev/mustek c 180 32 17 * 18 * The driver supports only one camera. 19 * 20 * Fix: mdc800 used sleep_on and slept with io_lock held. 21 * Converted sleep_on to waitqueues with schedule_timeout and made io_lock 22 * a semaphore from a spinlock. 23 * by Oliver Neukum <oliver@neukum.name> 24 * (02/12/2001) 25 * 26 * Identify version on module load. 27 * (08/04/2001) gb 28 * 29 * version 0.7.5 30 * Fixed potential SMP races with Spinlocks. 31 * Thanks to Oliver Neukum <oliver@neukum.name> who 32 * noticed the race conditions. 33 * (30/10/2000) 34 * 35 * Fixed: Setting urb->dev before submitting urb. 36 * by Greg KH <greg@kroah.com> 37 * (13/10/2000) 38 * 39 * version 0.7.3 40 * bugfix : The mdc800->state field gets set to READY after the 41 * disconnect function sets it to NOT_CONNECTED. This makes the 42 * driver running like the camera is connected and causes some 43 * hang ups. 44 * 45 * version 0.7.1 46 * MOD_INC and MOD_DEC are changed in usb_probe to prevent load/unload 47 * problems when compiled as Module. 48 * (04/04/2000) 49 * 50 * The mdc800 driver gets assigned the USB Minor 32-47. The Registration 51 * was updated to use these values. 52 * (26/03/2000) 53 * 54 * The Init und Exit Module Function are updated. 55 * (01/03/2000) 56 * 57 * version 0.7.0 58 * Rewrite of the driver : The driver now uses URB's. The old stuff 59 * has been removed. 60 * 61 * version 0.6.0 62 * Rewrite of this driver: The Emulation of the rs232 protocoll 63 * has been removed from the driver. A special executeCommand function 64 * for this driver is included to gphoto. 65 * The driver supports two kind of communication to bulk endpoints. 66 * Either with the dev->bus->ops->bulk... or with callback function. 67 * (09/11/1999) 68 * 69 * version 0.5.0: 70 * first Version that gets a version number. Most of the needed 71 * functions work. 72 * (20/10/1999) 73 */ 74 75 #include <linux/sched/signal.h> 76 #include <linux/signal.h> 77 #include <linux/spinlock.h> 78 #include <linux/errno.h> 79 #include <linux/random.h> 80 #include <linux/poll.h> 81 #include <linux/init.h> 82 #include <linux/slab.h> 83 #include <linux/module.h> 84 #include <linux/wait.h> 85 #include <linux/mutex.h> 86 87 #include <linux/usb.h> 88 #include <linux/fs.h> 89 90 /* 91 * Version Information 92 */ 93 #define DRIVER_VERSION "v0.7.5 (30/10/2000)" 94 #define DRIVER_AUTHOR "Henning Zabel <henning@uni-paderborn.de>" 95 #define DRIVER_DESC "USB Driver for Mustek MDC800 Digital Camera" 96 97 /* Vendor and Product Information */ 98 #define MDC800_VENDOR_ID 0x055f 99 #define MDC800_PRODUCT_ID 0xa800 100 101 /* Timeouts (msec) */ 102 #define TO_DOWNLOAD_GET_READY 1500 103 #define TO_DOWNLOAD_GET_BUSY 1500 104 #define TO_WRITE_GET_READY 1000 105 #define TO_DEFAULT_COMMAND 5000 106 #define TO_READ_FROM_IRQ TO_DEFAULT_COMMAND 107 #define TO_GET_READY TO_DEFAULT_COMMAND 108 109 /* Minor Number of the device (create with mknod /dev/mustek c 180 32) */ 110 #define MDC800_DEVICE_MINOR_BASE 32 111 112 113 /************************************************************************** 114 Data and structs 115 ***************************************************************************/ 116 117 118 typedef enum { 119 NOT_CONNECTED, READY, WORKING, DOWNLOAD 120 } mdc800_state; 121 122 123 /* Data for the driver */ 124 struct mdc800_data 125 { 126 struct usb_device * dev; // Device Data 127 mdc800_state state; 128 129 unsigned int endpoint [4]; 130 131 struct urb * irq_urb; 132 wait_queue_head_t irq_wait; 133 int irq_woken; 134 char* irq_urb_buffer; 135 136 int camera_busy; // is camera busy ? 137 int camera_request_ready; // Status to synchronize with irq 138 char camera_response [8]; // last Bytes send after busy 139 140 struct urb * write_urb; 141 char* write_urb_buffer; 142 wait_queue_head_t write_wait; 143 int written; 144 145 146 struct urb * download_urb; 147 char* download_urb_buffer; 148 wait_queue_head_t download_wait; 149 int downloaded; 150 int download_left; // Bytes left to download ? 151 152 153 /* Device Data */ 154 char out [64]; // Answer Buffer 155 int out_ptr; // Index to the first not readen byte 156 int out_count; // Bytes in the buffer 157 158 int open; // Camera device open ? 159 struct mutex io_lock; // IO -lock 160 161 char in [8]; // Command Input Buffer 162 int in_count; 163 164 int pic_index; // Cache for the Imagesize (-1 for nothing cached ) 165 int pic_len; 166 int minor; 167 }; 168 169 170 /* Specification of the Endpoints */ 171 static struct usb_endpoint_descriptor mdc800_ed [4] = 172 { 173 { 174 .bLength = 0, 175 .bDescriptorType = 0, 176 .bEndpointAddress = 0x01, 177 .bmAttributes = 0x02, 178 .wMaxPacketSize = cpu_to_le16(8), 179 .bInterval = 0, 180 .bRefresh = 0, 181 .bSynchAddress = 0, 182 }, 183 { 184 .bLength = 0, 185 .bDescriptorType = 0, 186 .bEndpointAddress = 0x82, 187 .bmAttributes = 0x03, 188 .wMaxPacketSize = cpu_to_le16(8), 189 .bInterval = 0, 190 .bRefresh = 0, 191 .bSynchAddress = 0, 192 }, 193 { 194 .bLength = 0, 195 .bDescriptorType = 0, 196 .bEndpointAddress = 0x03, 197 .bmAttributes = 0x02, 198 .wMaxPacketSize = cpu_to_le16(64), 199 .bInterval = 0, 200 .bRefresh = 0, 201 .bSynchAddress = 0, 202 }, 203 { 204 .bLength = 0, 205 .bDescriptorType = 0, 206 .bEndpointAddress = 0x84, 207 .bmAttributes = 0x02, 208 .wMaxPacketSize = cpu_to_le16(64), 209 .bInterval = 0, 210 .bRefresh = 0, 211 .bSynchAddress = 0, 212 }, 213 }; 214 215 /* The Variable used by the driver */ 216 static struct mdc800_data* mdc800; 217 218 219 /*************************************************************************** 220 The USB Part of the driver 221 ****************************************************************************/ 222 223 static int mdc800_endpoint_equals (struct usb_endpoint_descriptor *a,struct usb_endpoint_descriptor *b) 224 { 225 return ( 226 ( a->bEndpointAddress == b->bEndpointAddress ) 227 && ( a->bmAttributes == b->bmAttributes ) 228 && ( a->wMaxPacketSize == b->wMaxPacketSize ) 229 ); 230 } 231 232 233 /* 234 * Checks whether the camera responds busy 235 */ 236 static int mdc800_isBusy (char* ch) 237 { 238 int i=0; 239 while (i<8) 240 { 241 if (ch [i] != (char)0x99) 242 return 0; 243 i++; 244 } 245 return 1; 246 } 247 248 249 /* 250 * Checks whether the Camera is ready 251 */ 252 static int mdc800_isReady (char *ch) 253 { 254 int i=0; 255 while (i<8) 256 { 257 if (ch [i] != (char)0xbb) 258 return 0; 259 i++; 260 } 261 return 1; 262 } 263 264 265 266 /* 267 * USB IRQ Handler for InputLine 268 */ 269 static void mdc800_usb_irq (struct urb *urb) 270 { 271 int data_received=0, wake_up; 272 unsigned char* b=urb->transfer_buffer; 273 struct mdc800_data* mdc800=urb->context; 274 struct device *dev = &mdc800->dev->dev; 275 int status = urb->status; 276 277 if (status >= 0) { 278 if (mdc800_isBusy (b)) 279 { 280 if (!mdc800->camera_busy) 281 { 282 mdc800->camera_busy=1; 283 dev_dbg(dev, "gets busy\n"); 284 } 285 } 286 else 287 { 288 if (mdc800->camera_busy && mdc800_isReady (b)) 289 { 290 mdc800->camera_busy=0; 291 dev_dbg(dev, "gets ready\n"); 292 } 293 } 294 if (!(mdc800_isBusy (b) || mdc800_isReady (b))) 295 { 296 /* Store Data in camera_answer field */ 297 dev_dbg(dev, "%i %i %i %i %i %i %i %i \n",b[0],b[1],b[2],b[3],b[4],b[5],b[6],b[7]); 298 299 memcpy (mdc800->camera_response,b,8); 300 data_received=1; 301 } 302 } 303 wake_up= ( mdc800->camera_request_ready > 0 ) 304 && 305 ( 306 ((mdc800->camera_request_ready == 1) && (!mdc800->camera_busy)) 307 || 308 ((mdc800->camera_request_ready == 2) && data_received) 309 || 310 ((mdc800->camera_request_ready == 3) && (mdc800->camera_busy)) 311 || 312 (status < 0) 313 ); 314 315 if (wake_up) 316 { 317 mdc800->camera_request_ready=0; 318 mdc800->irq_woken=1; 319 wake_up (&mdc800->irq_wait); 320 } 321 } 322 323 324 /* 325 * Waits a while until the irq responds that camera is ready 326 * 327 * mode : 0: Wait for camera gets ready 328 * 1: Wait for receiving data 329 * 2: Wait for camera gets busy 330 * 331 * msec: Time to wait 332 */ 333 static int mdc800_usb_waitForIRQ (int mode, int msec) 334 { 335 mdc800->camera_request_ready=1+mode; 336 337 wait_event_timeout(mdc800->irq_wait, mdc800->irq_woken, 338 msecs_to_jiffies(msec)); 339 mdc800->irq_woken = 0; 340 341 if (mdc800->camera_request_ready>0) 342 { 343 mdc800->camera_request_ready=0; 344 dev_err(&mdc800->dev->dev, "timeout waiting for camera.\n"); 345 return -1; 346 } 347 348 if (mdc800->state == NOT_CONNECTED) 349 { 350 printk(KERN_WARNING "mdc800: Camera gets disconnected " 351 "during waiting for irq.\n"); 352 mdc800->camera_request_ready=0; 353 return -2; 354 } 355 356 return 0; 357 } 358 359 360 /* 361 * The write_urb callback function 362 */ 363 static void mdc800_usb_write_notify (struct urb *urb) 364 { 365 struct mdc800_data* mdc800=urb->context; 366 int status = urb->status; 367 368 if (status != 0) 369 dev_err(&mdc800->dev->dev, 370 "writing command fails (status=%i)\n", status); 371 else 372 mdc800->state=READY; 373 mdc800->written = 1; 374 wake_up (&mdc800->write_wait); 375 } 376 377 378 /* 379 * The download_urb callback function 380 */ 381 static void mdc800_usb_download_notify (struct urb *urb) 382 { 383 struct mdc800_data* mdc800=urb->context; 384 int status = urb->status; 385 386 if (status == 0) { 387 /* Fill output buffer with these data */ 388 memcpy (mdc800->out, urb->transfer_buffer, 64); 389 mdc800->out_count=64; 390 mdc800->out_ptr=0; 391 mdc800->download_left-=64; 392 if (mdc800->download_left == 0) 393 { 394 mdc800->state=READY; 395 } 396 } else { 397 dev_err(&mdc800->dev->dev, 398 "request bytes fails (status:%i)\n", status); 399 } 400 mdc800->downloaded = 1; 401 wake_up (&mdc800->download_wait); 402 } 403 404 405 /*************************************************************************** 406 Probing for the Camera 407 ***************************************************************************/ 408 409 static struct usb_driver mdc800_usb_driver; 410 static const struct file_operations mdc800_device_ops; 411 static struct usb_class_driver mdc800_class = { 412 .name = "mdc800%d", 413 .fops = &mdc800_device_ops, 414 .minor_base = MDC800_DEVICE_MINOR_BASE, 415 }; 416 417 418 /* 419 * Callback to search the Mustek MDC800 on the USB Bus 420 */ 421 static int mdc800_usb_probe (struct usb_interface *intf, 422 const struct usb_device_id *id) 423 { 424 int i,j; 425 struct usb_host_interface *intf_desc; 426 struct usb_device *dev = interface_to_usbdev (intf); 427 int irq_interval=0; 428 int retval; 429 430 dev_dbg(&intf->dev, "(%s) called.\n", __func__); 431 432 433 if (mdc800->dev != NULL) 434 { 435 dev_warn(&intf->dev, "only one Mustek MDC800 is supported.\n"); 436 return -ENODEV; 437 } 438 439 if (dev->descriptor.bNumConfigurations != 1) 440 { 441 dev_err(&intf->dev, 442 "probe fails -> wrong Number of Configuration\n"); 443 return -ENODEV; 444 } 445 intf_desc = intf->cur_altsetting; 446 447 if ( 448 ( intf_desc->desc.bInterfaceClass != 0xff ) 449 || ( intf_desc->desc.bInterfaceSubClass != 0 ) 450 || ( intf_desc->desc.bInterfaceProtocol != 0 ) 451 || ( intf_desc->desc.bNumEndpoints != 4) 452 ) 453 { 454 dev_err(&intf->dev, "probe fails -> wrong Interface\n"); 455 return -ENODEV; 456 } 457 458 /* Check the Endpoints */ 459 for (i=0; i<4; i++) 460 { 461 mdc800->endpoint[i]=-1; 462 for (j=0; j<4; j++) 463 { 464 if (mdc800_endpoint_equals (&intf_desc->endpoint [j].desc,&mdc800_ed [i])) 465 { 466 mdc800->endpoint[i]=intf_desc->endpoint [j].desc.bEndpointAddress ; 467 if (i==1) 468 { 469 irq_interval=intf_desc->endpoint [j].desc.bInterval; 470 } 471 } 472 } 473 if (mdc800->endpoint[i] == -1) 474 { 475 dev_err(&intf->dev, "probe fails -> Wrong Endpoints.\n"); 476 return -ENODEV; 477 } 478 } 479 480 481 dev_info(&intf->dev, "Found Mustek MDC800 on USB.\n"); 482 483 mutex_lock(&mdc800->io_lock); 484 485 retval = usb_register_dev(intf, &mdc800_class); 486 if (retval) { 487 dev_err(&intf->dev, "Not able to get a minor for this device.\n"); 488 mutex_unlock(&mdc800->io_lock); 489 return -ENODEV; 490 } 491 492 mdc800->dev=dev; 493 mdc800->open=0; 494 495 /* Setup URB Structs */ 496 usb_fill_int_urb ( 497 mdc800->irq_urb, 498 mdc800->dev, 499 usb_rcvintpipe (mdc800->dev,mdc800->endpoint [1]), 500 mdc800->irq_urb_buffer, 501 8, 502 mdc800_usb_irq, 503 mdc800, 504 irq_interval 505 ); 506 507 usb_fill_bulk_urb ( 508 mdc800->write_urb, 509 mdc800->dev, 510 usb_sndbulkpipe (mdc800->dev, mdc800->endpoint[0]), 511 mdc800->write_urb_buffer, 512 8, 513 mdc800_usb_write_notify, 514 mdc800 515 ); 516 517 usb_fill_bulk_urb ( 518 mdc800->download_urb, 519 mdc800->dev, 520 usb_rcvbulkpipe (mdc800->dev, mdc800->endpoint [3]), 521 mdc800->download_urb_buffer, 522 64, 523 mdc800_usb_download_notify, 524 mdc800 525 ); 526 527 mdc800->state=READY; 528 529 mutex_unlock(&mdc800->io_lock); 530 531 usb_set_intfdata(intf, mdc800); 532 return 0; 533 } 534 535 536 /* 537 * Disconnect USB device (maybe the MDC800) 538 */ 539 static void mdc800_usb_disconnect (struct usb_interface *intf) 540 { 541 struct mdc800_data* mdc800 = usb_get_intfdata(intf); 542 543 dev_dbg(&intf->dev, "(%s) called\n", __func__); 544 545 if (mdc800) { 546 if (mdc800->state == NOT_CONNECTED) 547 return; 548 549 usb_deregister_dev(intf, &mdc800_class); 550 551 /* must be under lock to make sure no URB 552 is submitted after usb_kill_urb() */ 553 mutex_lock(&mdc800->io_lock); 554 mdc800->state=NOT_CONNECTED; 555 556 usb_kill_urb(mdc800->irq_urb); 557 usb_kill_urb(mdc800->write_urb); 558 usb_kill_urb(mdc800->download_urb); 559 mutex_unlock(&mdc800->io_lock); 560 561 mdc800->dev = NULL; 562 usb_set_intfdata(intf, NULL); 563 } 564 dev_info(&intf->dev, "Mustek MDC800 disconnected from USB.\n"); 565 } 566 567 568 /*************************************************************************** 569 The Misc device Part (file_operations) 570 ****************************************************************************/ 571 572 /* 573 * This Function calc the Answersize for a command. 574 */ 575 static int mdc800_getAnswerSize (char command) 576 { 577 switch ((unsigned char) command) 578 { 579 case 0x2a: 580 case 0x49: 581 case 0x51: 582 case 0x0d: 583 case 0x20: 584 case 0x07: 585 case 0x01: 586 case 0x25: 587 case 0x00: 588 return 8; 589 590 case 0x05: 591 case 0x3e: 592 return mdc800->pic_len; 593 594 case 0x09: 595 return 4096; 596 597 default: 598 return 0; 599 } 600 } 601 602 603 /* 604 * Init the device: (1) alloc mem (2) Increase MOD Count .. 605 */ 606 static int mdc800_device_open (struct inode* inode, struct file *file) 607 { 608 int retval=0; 609 int errn=0; 610 611 mutex_lock(&mdc800->io_lock); 612 613 if (mdc800->state == NOT_CONNECTED) 614 { 615 errn=-EBUSY; 616 goto error_out; 617 } 618 if (mdc800->open) 619 { 620 errn=-EBUSY; 621 goto error_out; 622 } 623 624 mdc800->in_count=0; 625 mdc800->out_count=0; 626 mdc800->out_ptr=0; 627 mdc800->pic_index=0; 628 mdc800->pic_len=-1; 629 mdc800->download_left=0; 630 631 mdc800->camera_busy=0; 632 mdc800->camera_request_ready=0; 633 634 retval=0; 635 mdc800->irq_urb->dev = mdc800->dev; 636 retval = usb_submit_urb (mdc800->irq_urb, GFP_KERNEL); 637 if (retval) { 638 dev_err(&mdc800->dev->dev, 639 "request USB irq fails (submit_retval=%i).\n", retval); 640 errn = -EIO; 641 goto error_out; 642 } 643 644 mdc800->open=1; 645 dev_dbg(&mdc800->dev->dev, "Mustek MDC800 device opened.\n"); 646 647 error_out: 648 mutex_unlock(&mdc800->io_lock); 649 return errn; 650 } 651 652 653 /* 654 * Close the Camera and release Memory 655 */ 656 static int mdc800_device_release (struct inode* inode, struct file *file) 657 { 658 int retval=0; 659 660 mutex_lock(&mdc800->io_lock); 661 if (mdc800->open && (mdc800->state != NOT_CONNECTED)) 662 { 663 usb_kill_urb(mdc800->irq_urb); 664 usb_kill_urb(mdc800->write_urb); 665 usb_kill_urb(mdc800->download_urb); 666 mdc800->open=0; 667 } 668 else 669 { 670 retval=-EIO; 671 } 672 673 mutex_unlock(&mdc800->io_lock); 674 return retval; 675 } 676 677 678 /* 679 * The Device read callback Function 680 */ 681 static ssize_t mdc800_device_read (struct file *file, char __user *buf, size_t len, loff_t *pos) 682 { 683 size_t left=len, sts=len; /* single transfer size */ 684 char __user *ptr = buf; 685 int retval; 686 687 mutex_lock(&mdc800->io_lock); 688 if (mdc800->state == NOT_CONNECTED) 689 { 690 mutex_unlock(&mdc800->io_lock); 691 return -EBUSY; 692 } 693 if (mdc800->state == WORKING) 694 { 695 printk(KERN_WARNING "mdc800: Illegal State \"working\"" 696 "reached during read ?!\n"); 697 mutex_unlock(&mdc800->io_lock); 698 return -EBUSY; 699 } 700 if (!mdc800->open) 701 { 702 mutex_unlock(&mdc800->io_lock); 703 return -EBUSY; 704 } 705 706 while (left) 707 { 708 if (signal_pending (current)) 709 { 710 mutex_unlock(&mdc800->io_lock); 711 return -EINTR; 712 } 713 714 sts=left > (mdc800->out_count-mdc800->out_ptr)?mdc800->out_count-mdc800->out_ptr:left; 715 716 if (sts <= 0) 717 { 718 /* Too less Data in buffer */ 719 if (mdc800->state == DOWNLOAD) 720 { 721 mdc800->out_count=0; 722 mdc800->out_ptr=0; 723 724 /* Download -> Request new bytes */ 725 mdc800->download_urb->dev = mdc800->dev; 726 retval = usb_submit_urb (mdc800->download_urb, GFP_KERNEL); 727 if (retval) { 728 dev_err(&mdc800->dev->dev, 729 "Can't submit download urb " 730 "(retval=%i)\n", retval); 731 mutex_unlock(&mdc800->io_lock); 732 return len-left; 733 } 734 wait_event_timeout(mdc800->download_wait, 735 mdc800->downloaded, 736 msecs_to_jiffies(TO_DOWNLOAD_GET_READY)); 737 mdc800->downloaded = 0; 738 if (mdc800->download_urb->status != 0) 739 { 740 dev_err(&mdc800->dev->dev, 741 "request download-bytes fails " 742 "(status=%i)\n", 743 mdc800->download_urb->status); 744 mutex_unlock(&mdc800->io_lock); 745 return len-left; 746 } 747 } 748 else 749 { 750 /* No more bytes -> that's an error*/ 751 mutex_unlock(&mdc800->io_lock); 752 return -EIO; 753 } 754 } 755 else 756 { 757 /* Copy Bytes */ 758 if (copy_to_user(ptr, &mdc800->out [mdc800->out_ptr], 759 sts)) { 760 mutex_unlock(&mdc800->io_lock); 761 return -EFAULT; 762 } 763 ptr+=sts; 764 left-=sts; 765 mdc800->out_ptr+=sts; 766 } 767 } 768 769 mutex_unlock(&mdc800->io_lock); 770 return len-left; 771 } 772 773 774 /* 775 * The Device write callback Function 776 * If a 8Byte Command is received, it will be send to the camera. 777 * After this the driver initiates the request for the answer or 778 * just waits until the camera becomes ready. 779 */ 780 static ssize_t mdc800_device_write (struct file *file, const char __user *buf, size_t len, loff_t *pos) 781 { 782 size_t i=0; 783 int retval; 784 785 mutex_lock(&mdc800->io_lock); 786 if (mdc800->state != READY) 787 { 788 mutex_unlock(&mdc800->io_lock); 789 return -EBUSY; 790 } 791 if (!mdc800->open ) 792 { 793 mutex_unlock(&mdc800->io_lock); 794 return -EBUSY; 795 } 796 797 while (i<len) 798 { 799 unsigned char c; 800 if (signal_pending (current)) 801 { 802 mutex_unlock(&mdc800->io_lock); 803 return -EINTR; 804 } 805 806 if(get_user(c, buf+i)) 807 { 808 mutex_unlock(&mdc800->io_lock); 809 return -EFAULT; 810 } 811 812 /* check for command start */ 813 if (c == 0x55) 814 { 815 mdc800->in_count=0; 816 mdc800->out_count=0; 817 mdc800->out_ptr=0; 818 mdc800->download_left=0; 819 } 820 821 /* save command byte */ 822 if (mdc800->in_count < 8) 823 { 824 mdc800->in[mdc800->in_count] = c; 825 mdc800->in_count++; 826 } 827 else 828 { 829 mutex_unlock(&mdc800->io_lock); 830 return -EIO; 831 } 832 833 /* Command Buffer full ? -> send it to camera */ 834 if (mdc800->in_count == 8) 835 { 836 int answersize; 837 838 if (mdc800_usb_waitForIRQ (0,TO_GET_READY)) 839 { 840 dev_err(&mdc800->dev->dev, 841 "Camera didn't get ready.\n"); 842 mutex_unlock(&mdc800->io_lock); 843 return -EIO; 844 } 845 846 answersize=mdc800_getAnswerSize (mdc800->in[1]); 847 848 mdc800->state=WORKING; 849 memcpy (mdc800->write_urb->transfer_buffer, mdc800->in,8); 850 mdc800->write_urb->dev = mdc800->dev; 851 retval = usb_submit_urb (mdc800->write_urb, GFP_KERNEL); 852 if (retval) { 853 dev_err(&mdc800->dev->dev, 854 "submitting write urb fails " 855 "(retval=%i)\n", retval); 856 mutex_unlock(&mdc800->io_lock); 857 return -EIO; 858 } 859 wait_event_timeout(mdc800->write_wait, mdc800->written, 860 msecs_to_jiffies(TO_WRITE_GET_READY)); 861 mdc800->written = 0; 862 if (mdc800->state == WORKING) 863 { 864 usb_kill_urb(mdc800->write_urb); 865 mutex_unlock(&mdc800->io_lock); 866 return -EIO; 867 } 868 869 switch ((unsigned char) mdc800->in[1]) 870 { 871 case 0x05: /* Download Image */ 872 case 0x3e: /* Take shot in Fine Mode (WCam Mode) */ 873 if (mdc800->pic_len < 0) 874 { 875 dev_err(&mdc800->dev->dev, 876 "call 0x07 before " 877 "0x05,0x3e\n"); 878 mdc800->state=READY; 879 mutex_unlock(&mdc800->io_lock); 880 return -EIO; 881 } 882 mdc800->pic_len=-1; 883 fallthrough; 884 885 case 0x09: /* Download Thumbnail */ 886 mdc800->download_left=answersize+64; 887 mdc800->state=DOWNLOAD; 888 mdc800_usb_waitForIRQ (0,TO_DOWNLOAD_GET_BUSY); 889 break; 890 891 892 default: 893 if (answersize) 894 { 895 896 if (mdc800_usb_waitForIRQ (1,TO_READ_FROM_IRQ)) 897 { 898 dev_err(&mdc800->dev->dev, "requesting answer from irq fails\n"); 899 mutex_unlock(&mdc800->io_lock); 900 return -EIO; 901 } 902 903 /* Write dummy data, (this is ugly but part of the USB Protocol */ 904 /* if you use endpoint 1 as bulk and not as irq) */ 905 memcpy (mdc800->out, mdc800->camera_response,8); 906 907 /* This is the interpreted answer */ 908 memcpy (&mdc800->out[8], mdc800->camera_response,8); 909 910 mdc800->out_ptr=0; 911 mdc800->out_count=16; 912 913 /* Cache the Imagesize, if command was getImageSize */ 914 if (mdc800->in [1] == (char) 0x07) 915 { 916 mdc800->pic_len=(int) 65536*(unsigned char) mdc800->camera_response[0]+256*(unsigned char) mdc800->camera_response[1]+(unsigned char) mdc800->camera_response[2]; 917 918 dev_dbg(&mdc800->dev->dev, "cached imagesize = %i\n", mdc800->pic_len); 919 } 920 921 } 922 else 923 { 924 if (mdc800_usb_waitForIRQ (0,TO_DEFAULT_COMMAND)) 925 { 926 dev_err(&mdc800->dev->dev, "Command Timeout.\n"); 927 mutex_unlock(&mdc800->io_lock); 928 return -EIO; 929 } 930 } 931 mdc800->state=READY; 932 break; 933 } 934 } 935 i++; 936 } 937 mutex_unlock(&mdc800->io_lock); 938 return i; 939 } 940 941 942 /*************************************************************************** 943 Init and Cleanup this driver (Structs and types) 944 ****************************************************************************/ 945 946 /* File Operations of this drivers */ 947 static const struct file_operations mdc800_device_ops = 948 { 949 .owner = THIS_MODULE, 950 .read = mdc800_device_read, 951 .write = mdc800_device_write, 952 .open = mdc800_device_open, 953 .release = mdc800_device_release, 954 .llseek = noop_llseek, 955 }; 956 957 958 959 static const struct usb_device_id mdc800_table[] = { 960 { USB_DEVICE(MDC800_VENDOR_ID, MDC800_PRODUCT_ID) }, 961 { } /* Terminating entry */ 962 }; 963 964 MODULE_DEVICE_TABLE (usb, mdc800_table); 965 /* 966 * USB Driver Struct for this device 967 */ 968 static struct usb_driver mdc800_usb_driver = 969 { 970 .name = "mdc800", 971 .probe = mdc800_usb_probe, 972 .disconnect = mdc800_usb_disconnect, 973 .id_table = mdc800_table 974 }; 975 976 977 978 /************************************************************************ 979 Init and Cleanup this driver (Main Functions) 980 *************************************************************************/ 981 982 static int __init usb_mdc800_init (void) 983 { 984 int retval = -ENODEV; 985 /* Allocate Memory */ 986 mdc800=kzalloc (sizeof (struct mdc800_data), GFP_KERNEL); 987 if (!mdc800) 988 goto cleanup_on_fail; 989 990 mdc800->dev = NULL; 991 mdc800->state=NOT_CONNECTED; 992 mutex_init (&mdc800->io_lock); 993 994 init_waitqueue_head (&mdc800->irq_wait); 995 init_waitqueue_head (&mdc800->write_wait); 996 init_waitqueue_head (&mdc800->download_wait); 997 998 mdc800->irq_woken = 0; 999 mdc800->downloaded = 0; 1000 mdc800->written = 0; 1001 1002 mdc800->irq_urb_buffer=kmalloc (8, GFP_KERNEL); 1003 if (!mdc800->irq_urb_buffer) 1004 goto cleanup_on_fail; 1005 mdc800->write_urb_buffer=kmalloc (8, GFP_KERNEL); 1006 if (!mdc800->write_urb_buffer) 1007 goto cleanup_on_fail; 1008 mdc800->download_urb_buffer=kmalloc (64, GFP_KERNEL); 1009 if (!mdc800->download_urb_buffer) 1010 goto cleanup_on_fail; 1011 1012 mdc800->irq_urb=usb_alloc_urb (0, GFP_KERNEL); 1013 if (!mdc800->irq_urb) 1014 goto cleanup_on_fail; 1015 mdc800->download_urb=usb_alloc_urb (0, GFP_KERNEL); 1016 if (!mdc800->download_urb) 1017 goto cleanup_on_fail; 1018 mdc800->write_urb=usb_alloc_urb (0, GFP_KERNEL); 1019 if (!mdc800->write_urb) 1020 goto cleanup_on_fail; 1021 1022 /* Register the driver */ 1023 retval = usb_register(&mdc800_usb_driver); 1024 if (retval) 1025 goto cleanup_on_fail; 1026 1027 printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":" 1028 DRIVER_DESC "\n"); 1029 1030 return 0; 1031 1032 /* Clean driver up, when something fails */ 1033 1034 cleanup_on_fail: 1035 1036 if (mdc800 != NULL) 1037 { 1038 printk(KERN_ERR "mdc800: can't alloc memory!\n"); 1039 1040 kfree(mdc800->download_urb_buffer); 1041 kfree(mdc800->write_urb_buffer); 1042 kfree(mdc800->irq_urb_buffer); 1043 1044 usb_free_urb(mdc800->write_urb); 1045 usb_free_urb(mdc800->download_urb); 1046 usb_free_urb(mdc800->irq_urb); 1047 1048 kfree (mdc800); 1049 } 1050 mdc800 = NULL; 1051 return retval; 1052 } 1053 1054 1055 static void __exit usb_mdc800_cleanup (void) 1056 { 1057 usb_deregister (&mdc800_usb_driver); 1058 1059 usb_free_urb (mdc800->irq_urb); 1060 usb_free_urb (mdc800->download_urb); 1061 usb_free_urb (mdc800->write_urb); 1062 1063 kfree (mdc800->irq_urb_buffer); 1064 kfree (mdc800->write_urb_buffer); 1065 kfree (mdc800->download_urb_buffer); 1066 1067 kfree (mdc800); 1068 mdc800 = NULL; 1069 } 1070 1071 module_init (usb_mdc800_init); 1072 module_exit (usb_mdc800_cleanup); 1073 1074 MODULE_AUTHOR( DRIVER_AUTHOR ); 1075 MODULE_DESCRIPTION( DRIVER_DESC ); 1076 MODULE_LICENSE("GPL"); 1077 1078