pktcdvd.c revision ae03bf639a5027d27270123f5f6e3ee6a412781d
11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright (C) 2000 Jens Axboe <axboe@suse.de> 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright (C) 2001-2004 Peter Osterlund <petero2@telia.com> 4adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier * Copyright (C) 2006 Thomas Maier <balagi@justmail.de> 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * May be copied or modified under the terms of the GNU General Public 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * License. See linux/COPYING for more information. 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 9a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * Packet writing layer for ATAPI and SCSI CD-RW, DVD+RW, DVD-RW and 10a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * DVD-RAM devices. 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Theory of operation: 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 14a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * At the lowest level, there is the standard driver for the CD/DVD device, 15a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * typically ide-cd.c or sr.c. This driver can handle read and write requests, 16a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * but it doesn't know anything about the special restrictions that apply to 17a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * packet writing. One restriction is that write requests must be aligned to 18a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * packet boundaries on the physical media, and the size of a write request 19a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * must be equal to the packet size. Another restriction is that a 20a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * GPCMD_FLUSH_CACHE command has to be issued to the drive before a read 21a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * command, if the previous command was a write. 22a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * 23a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * The purpose of the packet writing driver is to hide these restrictions from 24a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * higher layers, such as file systems, and present a block device that can be 25a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * randomly read and written using 2kB-sized blocks. 26a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * 27a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * The lowest layer in the packet writing driver is the packet I/O scheduler. 28a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * Its data is defined by the struct packet_iosched and includes two bio 29a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * queues with pending read and write requests. These queues are processed 30a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * by the pkt_iosched_process_queue() function. The write requests in this 31a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * queue are already properly aligned and sized. This layer is responsible for 32a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * issuing the flush cache commands and scheduling the I/O in a good order. 33a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * 34a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * The next layer transforms unaligned write requests to aligned writes. This 35a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * transformation requires reading missing pieces of data from the underlying 36a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * block device, assembling the pieces to full packets and queuing them to the 37a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * packet I/O scheduler. 38a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * 39a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * At the top layer there is a custom make_request_fn function that forwards 40a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * read requests directly to the iosched queue and puts write requests in the 41a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * unaligned write queue. A kernel thread performs the necessary read 42a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * gathering to convert the unaligned writes to aligned writes and then feeds 43a676f8d092f2a3aff419cacae79c80c3b7f6c0f5Peter Osterlund * them to the packet I/O scheduler. 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *************************************************************************/ 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/pktcdvd.h> 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/types.h> 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kernel.h> 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kthread.h> 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/errno.h> 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/spinlock.h> 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/file.h> 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/proc_fs.h> 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/seq_file.h> 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/miscdevice.h> 587dfb71030f7636a0d65200158113c37764552f93Nigel Cunningham#include <linux/freezer.h> 591657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen#include <linux/mutex.h> 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <scsi/scsi_cmnd.h> 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <scsi/scsi_ioctl.h> 62cef289633a9321cd99dd5f6cc935657dc487e9f0Peter Osterlund#include <scsi/scsi.h> 6332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier#include <linux/debugfs.h> 6432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier#include <linux/device.h> 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/uaccess.h> 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 687822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier#define DRIVER_NAME "pktcdvd" 697822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if PACKET_DEBUG 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DPRINTK(fmt, args...) printk(KERN_NOTICE fmt, ##args) 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DPRINTK(fmt, args...) 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if PACKET_DEBUG > 1 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define VPRINTK(fmt, args...) printk(KERN_NOTICE fmt, ##args) 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define VPRINTK(fmt, args...) 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MAX_SPEED 0xffff 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ZONE(sector, pd) (((sector) + (pd)->offset) & ~((pd)->settings.size - 1)) 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct pktcdvd_device *pkt_devs[MAX_WRITERS]; 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct proc_dir_entry *pkt_proc; 88add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maierstatic int pktdev_major; 890a0fc9601dd1024ec7171993bf075a789246e1edThomas Maierstatic int write_congestion_on = PKT_WRITE_CONGESTION_ON; 900a0fc9601dd1024ec7171993bf075a789246e1edThomas Maierstatic int write_congestion_off = PKT_WRITE_CONGESTION_OFF; 911657f824e880a9bd239a3436b820d1a2986f763dJes Sorensenstatic struct mutex ctl_mutex; /* Serialize open/close/setup/teardown */ 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic mempool_t *psd_pool; 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct class *class_pktcdvd = NULL; /* /sys/class/pktcdvd */ 9532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct dentry *pkt_debugfs_root = NULL; /* /debug/pktcdvd */ 9632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 9732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* forward declaration */ 9832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_setup_dev(dev_t dev, dev_t* pkt_dev); 9932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_remove_dev(dev_t pkt_dev); 10032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_seq_show(struct seq_file *m, void *p); 10132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 10232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 10332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 10432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* 10532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * create and register a pktcdvd kernel object. 10632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier */ 10732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct pktcdvd_kobj* pkt_kobj_create(struct pktcdvd_device *pd, 10832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier const char* name, 10932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct kobject* parent, 11032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct kobj_type* ktype) 11132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 11232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct pktcdvd_kobj *p; 11389c426066462263c90957c37af29765855516b83Greg Kroah-Hartman int error; 11489c426066462263c90957c37af29765855516b83Greg Kroah-Hartman 11532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier p = kzalloc(sizeof(*p), GFP_KERNEL); 11632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!p) 11732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return NULL; 11832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier p->pd = pd; 11989c426066462263c90957c37af29765855516b83Greg Kroah-Hartman error = kobject_init_and_add(&p->kobj, ktype, parent, "%s", name); 12089c426066462263c90957c37af29765855516b83Greg Kroah-Hartman if (error) { 121d17a18dd92c91c784fcf7c785fa6bbf178fd0a6dDave Young kobject_put(&p->kobj); 12232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return NULL; 123d17a18dd92c91c784fcf7c785fa6bbf178fd0a6dDave Young } 12489c426066462263c90957c37af29765855516b83Greg Kroah-Hartman kobject_uevent(&p->kobj, KOBJ_ADD); 12532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return p; 12632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 12732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* 12832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * remove a pktcdvd kernel object. 12932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier */ 13032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_kobj_remove(struct pktcdvd_kobj *p) 13132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 13232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (p) 133c10997f6575f476ff38442fa18fd4a0d80345f9dGreg Kroah-Hartman kobject_put(&p->kobj); 13432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 13532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* 13632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * default release function for pktcdvd kernel objects. 13732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier */ 13832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_kobj_release(struct kobject *kobj) 13932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 14032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier kfree(to_pktcdvdkobj(kobj)); 14132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 14232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 14332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 14432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/********************************************************** 14532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * 14632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * sysfs interface for pktcdvd 14732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * by (C) 2006 Thomas Maier <balagi@justmail.de> 14832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * 14932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier **********************************************************/ 15032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 15132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier#define DEF_ATTR(_obj,_name,_mode) \ 1527b595756ec1f49e0049a9e01a1298d53a7faaa15Tejun Heo static struct attribute _obj = { .name = _name, .mode = _mode } 15332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 15432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/********************************************************** 15532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier /sys/class/pktcdvd/pktcdvd[0-7]/ 15632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/reset 15732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/packets_started 15832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/packets_finished 15932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/kb_written 16032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/kb_read 16132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/kb_read_gather 16232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier write_queue/size 16332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier write_queue/congestion_off 16432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier write_queue/congestion_on 16532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier **********************************************************/ 16632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 16732694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st1, "reset", 0200); 16832694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st2, "packets_started", 0444); 16932694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st3, "packets_finished", 0444); 17032694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st4, "kb_written", 0444); 17132694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st5, "kb_read", 0444); 17232694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st6, "kb_read_gather", 0444); 17332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 17432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct attribute *kobj_pkt_attrs_stat[] = { 17532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st1, 17632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st2, 17732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st3, 17832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st4, 17932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st5, 18032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st6, 18132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier NULL 18232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 18332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 18432694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_wq1, "size", 0444); 18532694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_wq2, "congestion_off", 0644); 18632694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_wq3, "congestion_on", 0644); 18732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 18832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct attribute *kobj_pkt_attrs_wqueue[] = { 18932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_wq1, 19032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_wq2, 19132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_wq3, 19232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier NULL 19332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 19432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 19532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic ssize_t kobj_pkt_show(struct kobject *kobj, 19632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct attribute *attr, char *data) 19732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 19832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct pktcdvd_device *pd = to_pktcdvdkobj(kobj)->pd; 19932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int n = 0; 20032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int v; 20132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (strcmp(attr->name, "packets_started") == 0) { 20232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.pkt_started); 20332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 20432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "packets_finished") == 0) { 20532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.pkt_ended); 20632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 20732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "kb_written") == 0) { 20832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.secs_w >> 1); 20932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 21032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "kb_read") == 0) { 21132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.secs_r >> 1); 21232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 21332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "kb_read_gather") == 0) { 21432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.secs_rg >> 1); 21532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 21632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "size") == 0) { 21732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 21832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier v = pd->bio_queue_size; 21932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 22032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%d\n", v); 22132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 22232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_off") == 0) { 22332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 22432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier v = pd->write_congestion_off; 22532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 22632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%d\n", v); 22732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 22832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_on") == 0) { 22932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 23032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier v = pd->write_congestion_on; 23132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 23232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%d\n", v); 23332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 23432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return n; 23532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 23632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 23732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void init_write_congestion_marks(int* lo, int* hi) 23832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 23932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (*hi > 0) { 24032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *hi = max(*hi, 500); 24132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *hi = min(*hi, 1000000); 24232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (*lo <= 0) 24332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = *hi - 100; 24432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier else { 24532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = min(*lo, *hi - 100); 24632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = max(*lo, 100); 24732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 24832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else { 24932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *hi = -1; 25032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = -1; 25132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 25232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 25332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 25432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic ssize_t kobj_pkt_store(struct kobject *kobj, 25532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct attribute *attr, 25632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier const char *data, size_t len) 25732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 25832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct pktcdvd_device *pd = to_pktcdvdkobj(kobj)->pd; 25932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int val; 26032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 26183f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier if (strcmp(attr->name, "reset") == 0 && len > 0) { 26232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.pkt_started = 0; 26332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.pkt_ended = 0; 26432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.secs_w = 0; 26532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.secs_rg = 0; 26632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.secs_r = 0; 26732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 26832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_off") == 0 26983f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier && sscanf(data, "%d", &val) == 1) { 27032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 27132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->write_congestion_off = val; 27232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier init_write_congestion_marks(&pd->write_congestion_off, 27332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &pd->write_congestion_on); 27432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 27532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 27632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_on") == 0 27783f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier && sscanf(data, "%d", &val) == 1) { 27832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 27932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->write_congestion_on = val; 28032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier init_write_congestion_marks(&pd->write_congestion_off, 28132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &pd->write_congestion_on); 28232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 28332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 28432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return len; 28532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 28632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 28732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct sysfs_ops kobj_pkt_ops = { 28832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .show = kobj_pkt_show, 28932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .store = kobj_pkt_store 29032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 29132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct kobj_type kobj_pkt_type_stat = { 29232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .release = pkt_kobj_release, 29332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .sysfs_ops = &kobj_pkt_ops, 29432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .default_attrs = kobj_pkt_attrs_stat 29532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 29632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct kobj_type kobj_pkt_type_wqueue = { 29732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .release = pkt_kobj_release, 29832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .sysfs_ops = &kobj_pkt_ops, 29932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .default_attrs = kobj_pkt_attrs_wqueue 30032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 30132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 30232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_sysfs_dev_new(struct pktcdvd_device *pd) 30332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 30432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (class_pktcdvd) { 305cba767175becadc5c4016cceb7bfdd2c7fe722f4Kay Sievers pd->dev = device_create(class_pktcdvd, NULL, MKDEV(0, 0), NULL, 3061ff9f542e5f87c299226557ce5e67a402ed4b502Greg Kroah-Hartman "%s", pd->name); 3076013c12be8313b3205b41912d965b03f3b06147dTony Jones if (IS_ERR(pd->dev)) 3086013c12be8313b3205b41912d965b03f3b06147dTony Jones pd->dev = NULL; 30932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 3106013c12be8313b3205b41912d965b03f3b06147dTony Jones if (pd->dev) { 31132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->kobj_stat = pkt_kobj_create(pd, "stat", 3126013c12be8313b3205b41912d965b03f3b06147dTony Jones &pd->dev->kobj, 31332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_type_stat); 31432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->kobj_wqueue = pkt_kobj_create(pd, "write_queue", 3156013c12be8313b3205b41912d965b03f3b06147dTony Jones &pd->dev->kobj, 31632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_type_wqueue); 31732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 31832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 31932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 32032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_sysfs_dev_remove(struct pktcdvd_device *pd) 32132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 32232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_kobj_remove(pd->kobj_stat); 32332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_kobj_remove(pd->kobj_wqueue); 32432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (class_pktcdvd) 3256013c12be8313b3205b41912d965b03f3b06147dTony Jones device_destroy(class_pktcdvd, pd->pkt_dev); 32632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 32732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 32832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 32932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/******************************************************************** 33032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier /sys/class/pktcdvd/ 33132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier add map block device 33232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier remove unmap packet dev 33332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier device_map show mappings 33432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *******************************************************************/ 33532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 33632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void class_pktcdvd_release(struct class *cls) 33732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 33832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier kfree(cls); 33932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 34032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic ssize_t class_pktcdvd_show_map(struct class *c, char *data) 34132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 34232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int n = 0; 34332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int idx; 34432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 34532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier for (idx = 0; idx < MAX_WRITERS; idx++) { 34632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct pktcdvd_device *pd = pkt_devs[idx]; 34732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!pd) 34832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier continue; 34932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n += sprintf(data+n, "%s %u:%u %u:%u\n", 35032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->name, 35132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier MAJOR(pd->pkt_dev), MINOR(pd->pkt_dev), 35232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier MAJOR(pd->bdev->bd_dev), 35332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier MINOR(pd->bdev->bd_dev)); 35432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 35532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier mutex_unlock(&ctl_mutex); 35632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return n; 35732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 35832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 35932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic ssize_t class_pktcdvd_store_add(struct class *c, const char *buf, 36032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier size_t count) 36132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 36232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier unsigned int major, minor; 363fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo 36483f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier if (sscanf(buf, "%u:%u", &major, &minor) == 2) { 365fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo /* pkt_setup_dev() expects caller to hold reference to self */ 366fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo if (!try_module_get(THIS_MODULE)) 367fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo return -ENODEV; 368fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo 36932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_setup_dev(MKDEV(major, minor), NULL); 370fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo 371fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo module_put(THIS_MODULE); 372fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo 37332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return count; 37432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 375fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo 37632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return -EINVAL; 37732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 37832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 37932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic ssize_t class_pktcdvd_store_remove(struct class *c, const char *buf, 38032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier size_t count) 38132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 38232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier unsigned int major, minor; 38383f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier if (sscanf(buf, "%u:%u", &major, &minor) == 2) { 38432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_remove_dev(MKDEV(major, minor)); 38532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return count; 38632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 38732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return -EINVAL; 38832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 38932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 39032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct class_attribute class_pktcdvd_attrs[] = { 39132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR(add, 0200, NULL, class_pktcdvd_store_add), 39232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR(remove, 0200, NULL, class_pktcdvd_store_remove), 39332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR(device_map, 0444, class_pktcdvd_show_map, NULL), 39432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR_NULL 39532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 39632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 39732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 39832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_sysfs_init(void) 39932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 40032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int ret = 0; 40132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 40232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier /* 40332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * create control files in sysfs 40432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * /sys/class/pktcdvd/... 40532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier */ 40632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd = kzalloc(sizeof(*class_pktcdvd), GFP_KERNEL); 40732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!class_pktcdvd) 40832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return -ENOMEM; 40932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->name = DRIVER_NAME; 41032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->owner = THIS_MODULE; 41132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->class_release = class_pktcdvd_release; 41232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->class_attrs = class_pktcdvd_attrs; 41332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier ret = class_register(class_pktcdvd); 41432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (ret) { 41532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier kfree(class_pktcdvd); 41632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd = NULL; 41732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier printk(DRIVER_NAME": failed to create class pktcdvd\n"); 41832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return ret; 41932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 42032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return 0; 42132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 42232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 42332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_sysfs_cleanup(void) 42432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 42532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (class_pktcdvd) 42632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_destroy(class_pktcdvd); 42732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd = NULL; 42832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 42932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 43032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/******************************************************************** 43132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier entries in debugfs 43232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 43332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier /debugfs/pktcdvd[0-7]/ 43432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier info 43532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 43632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *******************************************************************/ 43732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 43832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_debugfs_seq_show(struct seq_file *m, void *p) 43932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 44032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return pkt_seq_show(m, p); 44132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 44232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 44332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_debugfs_fops_open(struct inode *inode, struct file *file) 44432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 44532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return single_open(file, pkt_debugfs_seq_show, inode->i_private); 44632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 44732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 4482b8693c0617e972fc0b2fd1ebf8de97e15b656c3Arjan van de Venstatic const struct file_operations debug_fops = { 44932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .open = pkt_debugfs_fops_open, 45032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .read = seq_read, 45132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .llseek = seq_lseek, 45232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .release = single_release, 45332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .owner = THIS_MODULE, 45432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 45532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 45632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_dev_new(struct pktcdvd_device *pd) 45732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 45832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!pkt_debugfs_root) 45932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 46032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_f_info = NULL; 46132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_d_root = debugfs_create_dir(pd->name, pkt_debugfs_root); 46232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (IS_ERR(pd->dfs_d_root)) { 46332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_d_root = NULL; 46432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 46532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 46632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_f_info = debugfs_create_file("info", S_IRUGO, 46732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_d_root, pd, &debug_fops); 46832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (IS_ERR(pd->dfs_f_info)) { 46932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_f_info = NULL; 47032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 47132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 47232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 47332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 47432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_dev_remove(struct pktcdvd_device *pd) 47532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 47632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!pkt_debugfs_root) 47732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 47832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (pd->dfs_f_info) 47932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier debugfs_remove(pd->dfs_f_info); 48032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_f_info = NULL; 48132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (pd->dfs_d_root) 48232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier debugfs_remove(pd->dfs_d_root); 48332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_d_root = NULL; 48432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 48532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 48632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_init(void) 48732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 48832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_root = debugfs_create_dir(DRIVER_NAME, NULL); 48932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (IS_ERR(pkt_debugfs_root)) { 49032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_root = NULL; 49132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 49232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 49332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 49432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 49532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_cleanup(void) 49632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 49732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!pkt_debugfs_root) 49832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 49932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier debugfs_remove(pkt_debugfs_root); 50032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_root = NULL; 50132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 50232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 50332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* ----------------------------------------------------------*/ 50432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_bio_finished(struct pktcdvd_device *pd) 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(atomic_read(&pd->cdrw.pending_bios) <= 0); 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_dec_and_test(&pd->cdrw.pending_bios)) { 5107822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": queue empty\n"); 5111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->iosched.attention, 1); 5121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_bio_destructor(struct bio *bio) 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(bio->bi_io_vec); 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(bio); 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct bio *pkt_bio_alloc(int nr_iovecs) 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio_vec *bvl = NULL; 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio; 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = kmalloc(sizeof(struct bio), GFP_KERNEL); 5281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio) 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_bio; 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_init(bio); 5311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5321107d2e0352769b9bde6a4877c295b9309cdb877Peter Osterlund bvl = kcalloc(nr_iovecs, sizeof(struct bio_vec), GFP_KERNEL); 5331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bvl) 5341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_bvl; 5351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_max_vecs = nr_iovecs; 5371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_io_vec = bvl; 5381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_destructor = pkt_bio_destructor; 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return bio; 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds no_bvl: 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(bio); 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds no_bio: 5451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 5491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Allocate a packet_data struct 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 551e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlundstatic struct packet_data *pkt_alloc_packet_data(int frames) 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 5551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5561107d2e0352769b9bde6a4877c295b9309cdb877Peter Osterlund pkt = kzalloc(sizeof(struct packet_data), GFP_KERNEL); 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt) 5581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_pkt; 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 560e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund pkt->frames = frames; 561e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund pkt->w_bio = pkt_bio_alloc(frames); 5621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt->w_bio) 5631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_bio; 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 565e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames / FRAMES_PER_PAGE; i++) { 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->pages[i] = alloc_page(GFP_KERNEL|__GFP_ZERO); 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt->pages[i]) 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_page; 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_init(&pkt->lock); 5721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 573e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames; i++) { 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio = pkt_bio_alloc(1); 5751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio) 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_rd_bio; 5771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->r_bios[i] = bio; 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt; 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_rd_bio: 583e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames; i++) { 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio = pkt->r_bios[i]; 5851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio) 5861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(bio); 5871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_page: 590e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames / FRAMES_PER_PAGE; i++) 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->pages[i]) 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __free_page(pkt->pages[i]); 5931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(pkt->w_bio); 5941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_bio: 5951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pkt); 5961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_pkt: 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 6011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Free a packet_data struct 6021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_free_packet_data(struct packet_data *pkt) 6041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 6061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 607e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < pkt->frames; i++) { 6081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio = pkt->r_bios[i]; 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio) 6101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(bio); 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 612e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < pkt->frames / FRAMES_PER_PAGE; i++) 6131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __free_page(pkt->pages[i]); 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(pkt->w_bio); 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pkt); 6161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_shrink_pktlist(struct pktcdvd_device *pd) 6191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt, *next; 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!list_empty(&pd->cdrw.pkt_active_list)); 6231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry_safe(pkt, next, &pd->cdrw.pkt_free_list, list) { 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_free_packet_data(pkt); 6261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 627e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund INIT_LIST_HEAD(&pd->cdrw.pkt_free_list); 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_grow_pktlist(struct pktcdvd_device *pd, int nr_packets) 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 634e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund BUG_ON(!list_empty(&pd->cdrw.pkt_free_list)); 635e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund 6361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (nr_packets > 0) { 637e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund pkt = pkt_alloc_packet_data(pd->settings.size >> 2); 6381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt) { 6391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_shrink_pktlist(pd); 6401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 6411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->id = nr_packets; 6431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->pd = pd; 6441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add(&pkt->list, &pd->cdrw.pkt_free_list); 6451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds nr_packets--; 6461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 6481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline struct pkt_rb_node *pkt_rbtree_next(struct pkt_rb_node *node) 6511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *n = rb_next(&node->rb_node); 6531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!n) 6541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 6551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rb_entry(n, struct pkt_rb_node, rb_node); 6561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 658ac893963030ad70e528dc23270d499d650546a38Peter Osterlundstatic void pkt_rbtree_erase(struct pktcdvd_device *pd, struct pkt_rb_node *node) 6591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rb_erase(&node->rb_node, &pd->bio_queue); 6611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_free(node, pd->rb_pool); 6621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bio_queue_size--; 6631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->bio_queue_size < 0); 6641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 6671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Find the first node in the pd->bio_queue rb tree with a starting sector >= s. 6681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 6691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct pkt_rb_node *pkt_rbtree_find(struct pktcdvd_device *pd, sector_t s) 6701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *n = pd->bio_queue.rb_node; 6721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *next; 6731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *tmp; 6741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!n) { 6761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->bio_queue_size > 0); 6771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 6781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 6811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = rb_entry(n, struct pkt_rb_node, rb_node); 6821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (s <= tmp->bio->bi_sector) 6831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds next = n->rb_left; 6841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 6851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds next = n->rb_right; 6861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!next) 6871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds n = next; 6891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (s > tmp->bio->bi_sector) { 6921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = pkt_rbtree_next(tmp); 6931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!tmp) 6941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 6951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(s > tmp->bio->bi_sector); 6971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return tmp; 6981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Insert a node into the pd->bio_queue rb tree. 7021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_rbtree_insert(struct pktcdvd_device *pd, struct pkt_rb_node *node) 7041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node **p = &pd->bio_queue.rb_node; 7061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *parent = NULL; 7071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t s = node->bio->bi_sector; 7081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *tmp; 7091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (*p) { 7111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds parent = *p; 7121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = rb_entry(parent, struct pkt_rb_node, rb_node); 7131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (s < tmp->bio->bi_sector) 7141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = &(*p)->rb_left; 7151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 7161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = &(*p)->rb_right; 7171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rb_link_node(&node->rb_node, parent, p); 7191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rb_insert_color(&node->rb_node, &pd->bio_queue); 7201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bio_queue_size++; 7211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Add a bio to a single linked list defined by its head and tail pointers. 7251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 726ac893963030ad70e528dc23270d499d650546a38Peter Osterlundstatic void pkt_add_list_last(struct bio *bio, struct bio **list_head, struct bio **list_tail) 7271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_next = NULL; 7291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (*list_tail) { 7301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON((*list_head) == NULL); 7311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (*list_tail)->bi_next = bio; 7321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (*list_tail) = bio; 7331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 7341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON((*list_head) != NULL); 7351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (*list_head) = bio; 7361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (*list_tail) = bio; 7371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Remove and return the first bio from a single linked list defined by its 7421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * head and tail pointers. 7431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline struct bio *pkt_get_list_first(struct bio **list_head, struct bio **list_tail) 7451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio; 7471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (*list_head == NULL) 7491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 7501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = *list_head; 7521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *list_head = bio->bi_next; 7531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (*list_head == NULL) 7541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *list_tail = NULL; 7551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_next = NULL; 7571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return bio; 7581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Send a packet_command to the underlying block device and 7621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * wait for completion. 7631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_generic_packet(struct pktcdvd_device *pd, struct packet_command *cgc) 7651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 766165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboe struct request_queue *q = bdev_get_queue(pd->bdev); 7671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request *rq; 768406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig int ret = 0; 769406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig 770406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig rq = blk_get_request(q, (cgc->data_direction == CGC_DATA_WRITE) ? 771406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig WRITE : READ, __GFP_WAIT); 772406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig 773406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig if (cgc->buflen) { 774406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig if (blk_rq_map_kern(q, rq, cgc->buffer, cgc->buflen, __GFP_WAIT)) 775406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig goto out; 776406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig } 7771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 77891e4ee381d23ef67196a03924485aeceb32d6753Gerhard Dirschl rq->cmd_len = COMMAND_SIZE(cgc->cmd[0]); 779406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig memcpy(rq->cmd, cgc->cmd, CDROM_PACKET_SIZE); 7801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rq->timeout = 60*HZ; 7824aff5e2333c9a1609662f2091f55c3f6fffdad36Jens Axboe rq->cmd_type = REQ_TYPE_BLOCK_PC; 7834aff5e2333c9a1609662f2091f55c3f6fffdad36Jens Axboe rq->cmd_flags |= REQ_HARDBARRIER; 7841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cgc->quiet) 7854aff5e2333c9a1609662f2091f55c3f6fffdad36Jens Axboe rq->cmd_flags |= REQ_QUIET; 7861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 787406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig blk_execute_rq(rq->q, pd->bdev->bd_disk, rq, 0); 788cbc31a475a7f7748bd0a4e536533868e7cff8645Andrew Morton if (rq->errors) 789cbc31a475a7f7748bd0a4e536533868e7cff8645Andrew Morton ret = -EIO; 790406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwigout: 7911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_put_request(rq); 792406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig return ret; 7931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * A generic sense dump / resolve mechanism should be implemented across 7971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * all ATAPI + SCSI devices. 7981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_dump_sense(struct packet_command *cgc) 8001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds static char *info[9] = { "No sense", "Recovered error", "Not ready", 8021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "Medium error", "Hardware error", "Illegal request", 8031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "Unit attention", "Data protect", "Blank check" }; 8041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 8051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense *sense = cgc->sense; 8061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8077822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME":"); 8081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < CDROM_PACKET_SIZE; i++) 8091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(" %02x", cgc->cmd[i]); 8101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(" - "); 8111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sense == NULL) { 8131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("no sense\n"); 8141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 8151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("sense %02x.%02x.%02x", sense->sense_key, sense->asc, sense->ascq); 8181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sense->sense_key > 8) { 8201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(" (INVALID)\n"); 8211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 8221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(" (%s)\n", info[sense->sense_key]); 8251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 8281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * flush the drive cache to media 8291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 8301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_flush_cache(struct pktcdvd_device *pd) 8311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 8331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 8351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_FLUSH_CACHE; 8361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 8371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 8391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the IMMED bit -- we default to not setting it, although that 8401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * would allow a much faster close, this is safer 8411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 8421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 0 8431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 1 << 1; 8441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 8451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 8461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 8491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * speed is given as the normal factor, e.g. 4 for 4x 8501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 85105680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_set_speed(struct pktcdvd_device *pd, 85205680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlund unsigned write_speed, unsigned read_speed) 8531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 8551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 8561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 8571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 8591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 8601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_SET_SPEED; 8611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[2] = (read_speed >> 8) & 0xff; 8621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[3] = read_speed & 0xff; 8631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[4] = (write_speed >> 8) & 0xff; 8641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[5] = write_speed & 0xff; 8651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 8671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 8681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 8701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 8731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Queue a bio for processing by the low-level CD device. Must be called 8741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * from process context. 8751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 87646c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlundstatic void pkt_queue_bio(struct pktcdvd_device *pd, struct bio *bio) 8771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->iosched.lock); 8791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio_data_dir(bio) == READ) { 8801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_add_list_last(bio, &pd->iosched.read_queue, 8811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &pd->iosched.read_queue_tail); 8821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 8831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_add_list_last(bio, &pd->iosched.write_queue, 8841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &pd->iosched.write_queue_tail); 8851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->iosched.lock); 8871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->iosched.attention, 1); 8891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 8901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 8931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Process the queued read/write requests. This function handles special 8941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * requirements for CDRW drives: 8951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * - A cache flush command must be inserted before a read request if the 8961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * previous request was a write. 89746c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * - Switching between reading and writing is slow, so don't do it more often 8981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * than necessary. 89946c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * - Optimize for throughput at the expense of latency. This means that streaming 90046c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * writes will never be interrupted by a read, but if the drive has to seek 90146c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * before the next write, switch to reading instead if there are any pending 90246c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * read requests. 9031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * - Set the read speed according to current usage pattern. When only reading 9041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * from the device, it's best to use the highest possible read speed, but 9051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * when switching often between reading and writing, it's better to have the 9061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * same read and write speeds. 9071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_iosched_process_queue(struct pktcdvd_device *pd) 9091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->iosched.attention) == 0) 9121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 9131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->iosched.attention, 0); 9141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 9161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio; 91746c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund int reads_queued, writes_queued; 9181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->iosched.lock); 9201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds reads_queued = (pd->iosched.read_queue != NULL); 9211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writes_queued = (pd->iosched.write_queue != NULL); 9221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->iosched.lock); 9231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!reads_queued && !writes_queued) 9251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 9261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->iosched.writing) { 92846c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund int need_write_seek = 1; 92946c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund spin_lock(&pd->iosched.lock); 93046c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund bio = pd->iosched.write_queue; 93146c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund spin_unlock(&pd->iosched.lock); 93246c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund if (bio && (bio->bi_sector == pd->iosched.last_write)) 93346c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund need_write_seek = 0; 93446c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund if (need_write_seek && reads_queued) { 9351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->cdrw.pending_bios) > 0) { 9367822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": write, waiting\n"); 9371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 9381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_flush_cache(pd); 9401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->iosched.writing = 0; 9411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 9431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!reads_queued && writes_queued) { 9441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->cdrw.pending_bios) > 0) { 9457822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": read, waiting\n"); 9461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 9471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->iosched.writing = 1; 9491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->iosched.lock); 9531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->iosched.writing) { 9541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = pkt_get_list_first(&pd->iosched.write_queue, 9551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &pd->iosched.write_queue_tail); 9561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 9571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = pkt_get_list_first(&pd->iosched.read_queue, 9581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &pd->iosched.read_queue_tail); 9591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->iosched.lock); 9611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio) 9631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 9641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio_data_dir(bio) == READ) 9661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->iosched.successive_reads += bio->bi_size >> 10; 96746c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund else { 9681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->iosched.successive_reads = 0; 96946c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund pd->iosched.last_write = bio->bi_sector + bio_sectors(bio); 97046c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund } 9711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->iosched.successive_reads >= HI_SPEED_SWITCH) { 9721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->read_speed == pd->write_speed) { 9731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->read_speed = MAX_SPEED; 9741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, pd->write_speed, pd->read_speed); 9751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 9771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->read_speed != pd->write_speed) { 9781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->read_speed = pd->write_speed; 9791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, pd->write_speed, pd->read_speed); 9801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pd->cdrw.pending_bios); 9841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds generic_make_request(bio); 9851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 9891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Special care is needed if the underlying block device has a small 9901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * max_phys_segments value. 9911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 992165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboestatic int pkt_set_segment_merging(struct pktcdvd_device *pd, struct request_queue *q) 9931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 994ae03bf639a5027d27270123f5f6e3ee6a412781dMartin K. Petersen if ((pd->settings.size << 9) / CD_FRAMESIZE 995ae03bf639a5027d27270123f5f6e3ee6a412781dMartin K. Petersen <= queue_max_phys_segments(q)) { 9961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 9971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * The cdrom device can handle one segment/frame 9981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds clear_bit(PACKET_MERGE_SEGS, &pd->flags); 10001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1001ae03bf639a5027d27270123f5f6e3ee6a412781dMartin K. Petersen } else if ((pd->settings.size << 9) / PAGE_SIZE 1002ae03bf639a5027d27270123f5f6e3ee6a412781dMartin K. Petersen <= queue_max_phys_segments(q)) { 10031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 10041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * We can handle this case at the expense of some extra memory 10051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * copies during write operations 10061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 10071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_MERGE_SEGS, &pd->flags); 10081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 10091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 10107822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": cdrom max_phys_segments too small\n"); 10111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 10121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 10161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copy CD_FRAMESIZE bytes from src_bio into a destination page 10171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 10181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_copy_bio_data(struct bio *src_bio, int seg, int offs, struct page *dst_page, int dst_offs) 10191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int copy_size = CD_FRAMESIZE; 10211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (copy_size > 0) { 10231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio_vec *src_bvl = bio_iovec_idx(src_bio, seg); 10241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void *vfrom = kmap_atomic(src_bvl->bv_page, KM_USER0) + 10251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds src_bvl->bv_offset + offs; 10261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void *vto = page_address(dst_page) + dst_offs; 10271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int len = min_t(int, copy_size, src_bvl->bv_len - offs); 10281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(len < 0); 10301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy(vto, vfrom, len); 10311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kunmap_atomic(vfrom, KM_USER0); 10321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seg++; 10341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offs = 0; 10351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dst_offs += len; 10361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds copy_size -= len; 10371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 10411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copy all data for this packet to pkt->pages[], so that 10421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * a) The number of required segments for the write bio is minimized, which 10431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is necessary for some scsi controllers. 10441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * b) The data can be used as cache to avoid read requests if we receive a 10451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * new write request for the same zone. 10461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 10477277232374680595cdbc774fd246b206f56db015Peter Osterlundstatic void pkt_make_local_copy(struct packet_data *pkt, struct bio_vec *bvec) 10481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int f, p, offs; 10501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Copy all data to pkt->pages[] */ 10521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = 0; 10531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offs = 0; 10541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = 0; f < pkt->frames; f++) { 10557277232374680595cdbc774fd246b206f56db015Peter Osterlund if (bvec[f].bv_page != pkt->pages[p]) { 10567277232374680595cdbc774fd246b206f56db015Peter Osterlund void *vfrom = kmap_atomic(bvec[f].bv_page, KM_USER0) + bvec[f].bv_offset; 10571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void *vto = page_address(pkt->pages[p]) + offs; 10581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy(vto, vfrom, CD_FRAMESIZE); 10591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kunmap_atomic(vfrom, KM_USER0); 10607277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_page = pkt->pages[p]; 10617277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_offset = offs; 10621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 10637277232374680595cdbc774fd246b206f56db015Peter Osterlund BUG_ON(bvec[f].bv_offset != offs); 10641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offs += CD_FRAMESIZE; 10661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (offs >= PAGE_SIZE) { 10671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offs = 0; 10681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p++; 10691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10736712ecf8f648118c3363c142196418f89a510b90NeilBrownstatic void pkt_end_io_read(struct bio *bio, int err) 10741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt = bio->bi_private; 10761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = pkt->pd; 10771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!pd); 10781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_end_io_read: bio=%p sec0=%llx sec=%llx err=%d\n", bio, 10801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (unsigned long long)pkt->sector, (unsigned long long)bio->bi_sector, err); 10811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err) 10831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->io_errors); 10841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_dec_and_test(&pkt->io_wait)) { 10851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 10861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 10871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bio_finished(pd); 10891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10916712ecf8f648118c3363c142196418f89a510b90NeilBrownstatic void pkt_end_io_packet_write(struct bio *bio, int err) 10921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt = bio->bi_private; 10941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = pkt->pd; 10951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!pd); 10961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_end_io_packet_write: id=%d, err=%d\n", pkt->id, err); 10981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->stats.pkt_ended++; 11001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bio_finished(pd); 11021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_dec(&pkt->io_wait); 11031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 11041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 11051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 11081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Schedule reads for the holes in a packet 11091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 11101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_gather_data(struct pktcdvd_device *pd, struct packet_data *pkt) 11111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int frames_read = 0; 11131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio; 11141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int f; 11151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char written[PACKET_MAX_SIZE]; 11161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!pkt->orig_bios); 11181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->io_wait, 0); 11201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->io_errors, 0); 11211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 11231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Figure out which frames we need to read before we can write. 11241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 11251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(written, 0, sizeof(written)); 11261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 11271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (bio = pkt->orig_bios; bio; bio = bio->bi_next) { 11281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int first_frame = (bio->bi_sector - pkt->sector) / (CD_FRAMESIZE >> 9); 11291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int num_frames = bio->bi_size / CD_FRAMESIZE; 113006e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund pd->stats.secs_w += num_frames * (CD_FRAMESIZE >> 9); 11311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(first_frame < 0); 11321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(first_frame + num_frames > pkt->frames); 11331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = first_frame; f < first_frame + num_frames; f++) 11341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds written[f] = 1; 11351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 11371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 113806e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund if (pkt->cache_valid) { 113906e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund VPRINTK("pkt_gather_data: zone %llx cached\n", 114006e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund (unsigned long long)pkt->sector); 114106e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund goto out_account; 114206e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund } 114306e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund 11441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 11451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Schedule reads for missing parts of the packet. 11461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 11471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = 0; f < pkt->frames; f++) { 1148761a15e7ac0be7df0c86a55f38a84c080fa179aeJens Axboe struct bio_vec *vec; 1149761a15e7ac0be7df0c86a55f38a84c080fa179aeJens Axboe 11501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int p, offset; 11511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (written[f]) 11521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 11531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = pkt->r_bios[f]; 1154761a15e7ac0be7df0c86a55f38a84c080fa179aeJens Axboe vec = bio->bi_io_vec; 11551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_init(bio); 11561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_max_vecs = 1; 11571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_sector = pkt->sector + f * (CD_FRAMESIZE >> 9); 11581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_bdev = pd->bdev; 11591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_end_io = pkt_end_io_read; 11601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_private = pkt; 1161761a15e7ac0be7df0c86a55f38a84c080fa179aeJens Axboe bio->bi_io_vec = vec; 11627e3da6c4b9a69f44b758b2c88190ac33ac4ea1a1Laurent Riffard bio->bi_destructor = pkt_bio_destructor; 11631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = (f * CD_FRAMESIZE) / PAGE_SIZE; 11651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = (f * CD_FRAMESIZE) % PAGE_SIZE; 11661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_gather_data: Adding frame %d, page:%p offs:%d\n", 11671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds f, pkt->pages[p], offset); 11681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio_add_page(bio, pkt->pages[p], CD_FRAMESIZE, offset)) 11691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG(); 11701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->io_wait); 11721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_rw = READ; 117346c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund pkt_queue_bio(pd, bio); 11741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_read++; 11751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_account: 11781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_gather_data: need %d frames for zone %llx\n", 11791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_read, (unsigned long long)pkt->sector); 11801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->stats.pkt_started++; 11811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->stats.secs_rg += frames_read * (CD_FRAMESIZE >> 9); 11821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 11851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Find a packet matching zone, or the least recently used packet if 11861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * there is no match. 11871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 11881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct packet_data *pkt_get_packet_data(struct pktcdvd_device *pd, int zone) 11891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 11911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_free_list, list) { 11931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sector == zone || pkt->list.next == &pd->cdrw.pkt_free_list) { 11941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_del_init(&pkt->list); 11951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sector != zone) 11961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 0; 1197610827dee82731c7be5a135d750d194ac56881a9Peter Osterlund return pkt; 11981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1200610827dee82731c7be5a135d750d194ac56881a9Peter Osterlund BUG(); 1201610827dee82731c7be5a135d750d194ac56881a9Peter Osterlund return NULL; 12021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 12031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_put_packet_data(struct pktcdvd_device *pd, struct packet_data *pkt) 12051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 12061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->cache_valid) { 12071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add(&pkt->list, &pd->cdrw.pkt_free_list); 12081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 12091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add_tail(&pkt->list, &pd->cdrw.pkt_free_list); 12101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 12121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 12141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * recover a failed write, query for relocation if possible 12151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 12161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * returns 1 if recovery is possible, or 0 if not 12171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 12181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 12191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_start_recovery(struct packet_data *pkt) 12201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 12211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 12221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * FIXME. We need help from the file system to implement 12231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * recovery handling. 12241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 12251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 12261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 0 12271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request *rq = pkt->rq; 12281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = rq->rq_disk->private_data; 12291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct block_device *pkt_bdev; 12301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct super_block *sb = NULL; 12311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long old_block, new_block; 12321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t new_sector; 12331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bdev = bdget(kdev_t_to_nr(pd->pkt_dev)); 12351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt_bdev) { 12361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sb = get_super(pkt_bdev); 12371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdput(pkt_bdev); 12381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!sb) 12411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 12421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!sb->s_op || !sb->s_op->relocate_blocks) 12441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 12451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds old_block = pkt->sector / (CD_FRAMESIZE >> 9); 12471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sb->s_op->relocate_blocks(sb, old_block, &new_block)) 12481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 12491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds new_sector = new_block * (CD_FRAMESIZE >> 9); 12511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sector = new_sector; 12521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->bio->bi_sector = new_sector; 12541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->bio->bi_next = NULL; 12551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->bio->bi_flags = 1 << BIO_UPTODATE; 12561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->bio->bi_idx = 0; 12571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pkt->bio->bi_rw != (1 << BIO_RW)); 12591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pkt->bio->bi_vcnt != pkt->frames); 12601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pkt->bio->bi_size != pkt->frames * CD_FRAMESIZE); 12611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pkt->bio->bi_end_io != pkt_end_io_packet_write); 12621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pkt->bio->bi_private != pkt); 12631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds drop_super(sb); 12651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 12661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 12681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds drop_super(sb); 12691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 12701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 12711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 12721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void pkt_set_state(struct packet_data *pkt, enum packet_data_state state) 12741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 12751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if PACKET_DEBUG > 1 12761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds static const char *state_name[] = { 12771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "IDLE", "WAITING", "READ_WAIT", "WRITE_WAIT", "RECOVERY", "FINISHED" 12781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }; 12791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds enum packet_data_state old_state = pkt->state; 12801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt %2d : s=%6llx %s -> %s\n", pkt->id, (unsigned long long)pkt->sector, 12811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds state_name[old_state], state_name[state]); 12821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 12831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->state = state; 12841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 12851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 12871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Scan the work queue to see if we can start a new packet. 12881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * returns non-zero if any work was done. 12891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 12901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_handle_queue(struct pktcdvd_device *pd) 12911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 12921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt, *p; 12931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio = NULL; 12941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t zone = 0; /* Suppress gcc warning */ 12951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *node, *first_node; 12961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *n; 12970a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier int wakeup; 12981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("handle_queue\n"); 13001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->scan_queue, 0); 13021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (list_empty(&pd->cdrw.pkt_free_list)) { 13041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("handle_queue: no pkt\n"); 13051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 13061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 13091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Try to find a zone we are not already working on. 13101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 13111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->lock); 13121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds first_node = pkt_rbtree_find(pd, pd->current_sector); 13131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!first_node) { 13141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds n = rb_first(&pd->bio_queue); 13151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (n) 13161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds first_node = rb_entry(n, struct pkt_rb_node, rb_node); 13171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = first_node; 13191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (node) { 13201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = node->bio; 13211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds zone = ZONE(bio->bi_sector, pd); 13221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(p, &pd->cdrw.pkt_active_list, list) { 13237baeb6a5ccab2d472679a053e64a63ac423c3a42Peter Osterlund if (p->sector == zone) { 13247baeb6a5ccab2d472679a053e64a63ac423c3a42Peter Osterlund bio = NULL; 13251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto try_next_bio; 13267baeb6a5ccab2d472679a053e64a63ac423c3a42Peter Osterlund } 13271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 13291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldstry_next_bio: 13301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = pkt_rbtree_next(node); 13311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!node) { 13321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds n = rb_first(&pd->bio_queue); 13331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (n) 13341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = rb_entry(n, struct pkt_rb_node, rb_node); 13351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (node == first_node) 13371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = NULL; 13381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->lock); 13401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio) { 13411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("handle_queue: no bio\n"); 13421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 13431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt = pkt_get_packet_data(pd, zone); 13461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->current_sector = zone + pd->settings.size; 13481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sector = zone; 1349e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund BUG_ON(pkt->frames != pd->settings.size >> 2); 13501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->write_size = 0; 13511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 13531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Scan work queue for bios in the same zone and link them 13541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * to this packet. 13551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 13561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->lock); 13571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_handle_queue: looking for zone %llx\n", (unsigned long long)zone); 13581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while ((node = pkt_rbtree_find(pd, zone)) != NULL) { 13591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = node->bio; 13601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_handle_queue: found zone=%llx\n", 13611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (unsigned long long)ZONE(bio->bi_sector, pd)); 13621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ZONE(bio->bi_sector, pd) != zone) 13631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 13641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_rbtree_erase(pd, node); 13651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 13661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_add_list_last(bio, &pkt->orig_bios, &pkt->orig_bios_tail); 13671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->write_size += bio->bi_size / CD_FRAMESIZE; 13681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 13691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13700a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier /* check write congestion marks, and if bio_queue_size is 13710a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier below, wake up any waiters */ 13720a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier wakeup = (pd->write_congestion_on > 0 13730a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier && pd->bio_queue_size <= pd->write_congestion_off); 13741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->lock); 13750a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier if (wakeup) 137683f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier clear_bdi_congested(&pd->disk->queue->backing_dev_info, WRITE); 13771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time = max(PACKET_WAIT_TIME, 1); 13791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_WAITING_STATE); 13801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->run_sm, 1); 13811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 13831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add(&pkt->list, &pd->cdrw.pkt_active_list); 13841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 13851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 13871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 13881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 13901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Assemble a bio to write one packet and queue the bio for processing 13911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * by the underlying block device. 13921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 13931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_start_write(struct pktcdvd_device *pd, struct packet_data *pkt) 13941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 13951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio; 13961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int f; 13971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int frames_write; 13987277232374680595cdbc774fd246b206f56db015Peter Osterlund struct bio_vec *bvec = pkt->w_bio->bi_io_vec; 13991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = 0; f < pkt->frames; f++) { 14017277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_page = pkt->pages[(f * CD_FRAMESIZE) / PAGE_SIZE]; 14027277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_offset = (f * CD_FRAMESIZE) % PAGE_SIZE; 14031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 14067277232374680595cdbc774fd246b206f56db015Peter Osterlund * Fill-in bvec with data from orig_bios. 14071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 14081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_write = 0; 14091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 14101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (bio = pkt->orig_bios; bio; bio = bio->bi_next) { 14111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int segment = bio->bi_idx; 14121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int src_offs = 0; 14131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int first_frame = (bio->bi_sector - pkt->sector) / (CD_FRAMESIZE >> 9); 14141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int num_frames = bio->bi_size / CD_FRAMESIZE; 14151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(first_frame < 0); 14161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(first_frame + num_frames > pkt->frames); 14171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = first_frame; f < first_frame + num_frames; f++) { 14181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio_vec *src_bvl = bio_iovec_idx(bio, segment); 14191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (src_offs >= src_bvl->bv_len) { 14211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds src_offs -= src_bvl->bv_len; 14221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds segment++; 14231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(segment >= bio->bi_vcnt); 14241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds src_bvl = bio_iovec_idx(bio, segment); 14251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (src_bvl->bv_len - src_offs >= CD_FRAMESIZE) { 14287277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_page = src_bvl->bv_page; 14297277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_offset = src_bvl->bv_offset + src_offs; 14301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 14311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_copy_bio_data(bio, segment, src_offs, 14327277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_page, bvec[f].bv_offset); 14331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds src_offs += CD_FRAMESIZE; 14351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_write++; 14361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_WRITE_WAIT_STATE); 14391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 14401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_start_write: Writing %d frames for zone %llx\n", 14421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_write, (unsigned long long)pkt->sector); 14431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(frames_write != pkt->write_size); 14441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (test_bit(PACKET_MERGE_SEGS, &pd->flags) || (pkt->write_size < pkt->frames)) { 14467277232374680595cdbc774fd246b206f56db015Peter Osterlund pkt_make_local_copy(pkt, bvec); 14471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 1; 14481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 14491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 0; 14501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Start the write request */ 14531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_init(pkt->w_bio); 14541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_max_vecs = PACKET_MAX_SIZE; 14551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_sector = pkt->sector; 14561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_bdev = pd->bdev; 14571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_end_io = pkt_end_io_packet_write; 14581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_private = pkt; 1459761a15e7ac0be7df0c86a55f38a84c080fa179aeJens Axboe pkt->w_bio->bi_io_vec = bvec; 14607e3da6c4b9a69f44b758b2c88190ac33ac4ea1a1Laurent Riffard pkt->w_bio->bi_destructor = pkt_bio_destructor; 14617277232374680595cdbc774fd246b206f56db015Peter Osterlund for (f = 0; f < pkt->frames; f++) 14627277232374680595cdbc774fd246b206f56db015Peter Osterlund if (!bio_add_page(pkt->w_bio, bvec[f].bv_page, CD_FRAMESIZE, bvec[f].bv_offset)) 14637277232374680595cdbc774fd246b206f56db015Peter Osterlund BUG(); 14647822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": vcnt=%d\n", pkt->w_bio->bi_vcnt); 14651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->io_wait, 1); 14671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_rw = WRITE; 146846c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund pkt_queue_bio(pd, pkt->w_bio); 14691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 14701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_finish_packet(struct packet_data *pkt, int uptodate) 14721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 14731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio, *next; 14741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!uptodate) 14761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 0; 14771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Finish all bios corresponding to this packet */ 14791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = pkt->orig_bios; 14801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (bio) { 14811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds next = bio->bi_next; 14821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_next = NULL; 14836712ecf8f648118c3363c142196418f89a510b90NeilBrown bio_endio(bio, uptodate ? 0 : -EIO); 14841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = next; 14851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->orig_bios = pkt->orig_bios_tail = NULL; 14871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 14881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_run_state_machine(struct pktcdvd_device *pd, struct packet_data *pkt) 14901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 14911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int uptodate; 14921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("run_state_machine: pkt %d\n", pkt->id); 14941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 14961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (pkt->state) { 14971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_WAITING_STATE: 14981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pkt->write_size < pkt->frames) && (pkt->sleep_time > 0)) 14991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 15001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time = 0; 15021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_gather_data(pd, pkt); 15031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_READ_WAIT_STATE); 15041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 15051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_READ_WAIT_STATE: 15071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->io_wait) > 0) 15081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 15091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->io_errors) > 0) { 15111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_RECOVERY_STATE); 15121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 15131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_start_write(pd, pkt); 15141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 15161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_WRITE_WAIT_STATE: 15181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->io_wait) > 0) 15191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 15201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (test_bit(BIO_UPTODATE, &pkt->w_bio->bi_flags)) { 15221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_FINISHED_STATE); 15231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 15241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_RECOVERY_STATE); 15251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 15271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_RECOVERY_STATE: 15291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt_start_recovery(pkt)) { 15301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_start_write(pd, pkt); 15311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 15321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("No recovery possible\n"); 15331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_FINISHED_STATE); 15341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 15361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_FINISHED_STATE: 15381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uptodate = test_bit(BIO_UPTODATE, &pkt->w_bio->bi_flags); 15391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_finish_packet(pkt, uptodate); 15401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 15411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 15431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG(); 15441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 15451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_handle_packets(struct pktcdvd_device *pd) 15501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 15511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt, *next; 15521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_handle_packets\n"); 15541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 15561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Run state machine for active packets 15571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 15581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 15591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->run_sm) > 0) { 15601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->run_sm, 0); 15611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_run_state_machine(pd, pkt); 15621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 15661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Move no longer active packets to the free list 15671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 15681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 15691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry_safe(pkt, next, &pd->cdrw.pkt_active_list, list) { 15701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->state == PACKET_FINISHED_STATE) { 15711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_del(&pkt->list); 15721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_put_packet_data(pd, pkt); 15731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_IDLE_STATE); 15741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->scan_queue, 1); 15751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 15781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_count_states(struct pktcdvd_device *pd, int *states) 15811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 15821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 15831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 15841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1585ae7642bb05623988d8ca82b332dad1ed7bdb8cebPeter Osterlund for (i = 0; i < PACKET_NUM_STATES; i++) 15861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[i] = 0; 15871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 15891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 15901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[pkt->state]++; 15911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 15931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 15961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * kcdrwd is woken up when writes have been queued for one of our 15971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * registered devices 15981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 15991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int kcdrwd(void *foobar) 16001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = foobar; 16021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 16031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds long min_sleep_time, residue; 16041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_user_nice(current, -20); 1606831441862956fffa17b9801db37e6ea1650b0f69Rafael J. Wysocki set_freezable(); 16071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 16091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DECLARE_WAITQUEUE(wait, current); 16101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 16121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Wait until there is something to do 16131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 16141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_wait_queue(&pd->wqueue, &wait); 16151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 16161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_current_state(TASK_INTERRUPTIBLE); 16171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check if we need to run pkt_handle_queue */ 16191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->scan_queue) > 0) 16201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto work_to_do; 16211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check if we need to run the state machine for some packet */ 16231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 16241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->run_sm) > 0) 16251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto work_to_do; 16261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check if we need to process the iosched queues */ 16291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->iosched.attention) != 0) 16301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto work_to_do; 16311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Otherwise, go to sleep */ 16331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (PACKET_DEBUG > 1) { 16341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int states[PACKET_NUM_STATES]; 16351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_count_states(pd, states); 16361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("kcdrwd: i:%d ow:%d rw:%d ww:%d rec:%d fin:%d\n", 16371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[0], states[1], states[2], states[3], 16381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[4], states[5]); 16391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds min_sleep_time = MAX_SCHEDULE_TIMEOUT; 16421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 16431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sleep_time && pkt->sleep_time < min_sleep_time) 16441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds min_sleep_time = pkt->sleep_time; 16451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds generic_unplug_device(bdev_get_queue(pd->bdev)); 16481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("kcdrwd: sleeping\n"); 16501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds residue = schedule_timeout(min_sleep_time); 16511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("kcdrwd: wake up\n"); 16521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* make swsusp happy with our thread */ 16543e1d1d28d99dabe63c64f7f40f1ca1d646de1f73Christoph Lameter try_to_freeze(); 16551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 16571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt->sleep_time) 16581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 16591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time -= min_sleep_time - residue; 16601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sleep_time <= 0) { 16611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time = 0; 16621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 16631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (kthread_should_stop()) 16671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 16681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldswork_to_do: 16701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_current_state(TASK_RUNNING); 16711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remove_wait_queue(&pd->wqueue, &wait); 16721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (kthread_should_stop()) 16741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 16751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 16771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * if pkt_handle_queue returns true, we can queue 16781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * another request. 16791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 16801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (pkt_handle_queue(pd)) 16811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ; 16821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 16841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Handle packet state machine 16851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 16861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_handle_packets(pd); 16871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 16891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Handle iosched queues 16901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 16911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_iosched_process_queue(pd); 16921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 16951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 16961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_print_settings(struct pktcdvd_device *pd) 16981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16997822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": %s packets, ", pd->settings.fp ? "Fixed" : "Variable"); 17001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("%u blocks, ", pd->settings.size >> 2); 17011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("Mode-%c disc\n", pd->settings.block_mode == 8 ? '1' : '2'); 17021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_mode_sense(struct pktcdvd_device *pd, struct packet_command *cgc, int page_code, int page_control) 17051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 17061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(cgc->cmd, 0, sizeof(cgc->cmd)); 17071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[0] = GPCMD_MODE_SENSE_10; 17091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[2] = page_code | (page_control << 6); 17101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[7] = cgc->buflen >> 8; 17111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[8] = cgc->buflen & 0xff; 17121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->data_direction = CGC_DATA_READ; 17131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, cgc); 17141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_mode_select(struct pktcdvd_device *pd, struct packet_command *cgc) 17171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 17181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(cgc->cmd, 0, sizeof(cgc->cmd)); 17191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(cgc->buffer, 0, 2); 17201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[0] = GPCMD_MODE_SELECT_10; 17211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[1] = 0x10; /* PF */ 17221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[7] = cgc->buflen >> 8; 17231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[8] = cgc->buflen & 0xff; 17241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->data_direction = CGC_DATA_WRITE; 17251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, cgc); 17261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_get_disc_info(struct pktcdvd_device *pd, disc_information *di) 17291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 17301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 17311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 17321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* set up command and get the disc info */ 17341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, di, sizeof(*di), CGC_DATA_READ); 17351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_DISC_INFO; 17361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = cgc.buflen = 2; 17371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 17381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 17401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* not all drives have the same disc_info length, so requeue 17431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * packet with the length the drive tells us it can supply 17441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 17451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = be16_to_cpu(di->disc_information_length) + 17461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(di->disc_information_length); 17471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cgc.buflen > sizeof(disc_information)) 17491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = sizeof(disc_information); 17501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = cgc.buflen; 17521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 17531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_get_track_info(struct pktcdvd_device *pd, __u16 track, __u8 type, track_information *ti) 17561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 17571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 17581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 17591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, ti, 8, CGC_DATA_READ); 17611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_TRACK_RZONE_INFO; 17621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = type & 3; 17631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[4] = (track & 0xff00) >> 8; 17641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[5] = track & 0xff; 17651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = 8; 17661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 17671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 17691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = be16_to_cpu(ti->track_information_length) + 17721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(ti->track_information_length); 17731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cgc.buflen > sizeof(track_information)) 17751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = sizeof(track_information); 17761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = cgc.buflen; 17781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 17791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 178105680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_get_last_written(struct pktcdvd_device *pd, 178205680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlund long *last_written) 17831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 17841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disc_information di; 17851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds track_information ti; 17861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __u32 last_track; 17871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = -1; 17881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_disc_info(pd, &di))) 17901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last_track = (di.last_track_msb << 8) | di.last_track_lsb; 17931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_track_info(pd, last_track, 1, &ti))) 17941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* if this track is blank, try the previous. */ 17971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.blank) { 17981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last_track--; 17991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_track_info(pd, last_track, 1, &ti))) 18001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 18011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* if last recorded field is valid, return it. */ 18041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.lra_v) { 18051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *last_written = be32_to_cpu(ti.last_rec_address); 18061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 18071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* make it up instead */ 18081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *last_written = be32_to_cpu(ti.track_start) + 18091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds be32_to_cpu(ti.track_size); 18101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.free_blocks) 18111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *last_written -= (be32_to_cpu(ti.free_blocks) + 7); 18121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 18141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 18151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 18171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * write mode select package based on pd->settings 18181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 181905680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_set_write_settings(struct pktcdvd_device *pd) 18201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 18211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 18221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 18231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_param_page *wp; 18241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char buffer[128]; 18251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret, size; 18261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* doesn't apply to DVD+RW or DVD-RAM */ 18281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pd->mmc3_profile == 0x1a) || (pd->mmc3_profile == 0x12)) 18291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 18301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(buffer, 0, sizeof(buffer)); 18321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buffer, sizeof(*wp), CGC_DATA_READ); 18331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 18341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_sense(pd, &cgc, GPMODE_WRITE_PARMS_PAGE, 0))) { 18351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 18361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 18371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = 2 + ((buffer[0] << 8) | (buffer[1] & 0xff)); 18401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->mode_offset = (buffer[6] << 8) | (buffer[7] & 0xff); 18411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (size > sizeof(buffer)) 18421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = sizeof(buffer); 18431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 18451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * now get it all 18461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 18471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buffer, size, CGC_DATA_READ); 18481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 18491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_sense(pd, &cgc, GPMODE_WRITE_PARMS_PAGE, 0))) { 18501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 18511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 18521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 18551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * write page is offset header + block descriptor length 18561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 18571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp = (write_param_page *) &buffer[sizeof(struct mode_page_header) + pd->mode_offset]; 18581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->fp = pd->settings.fp; 18601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->track_mode = pd->settings.track_mode; 18611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->write_type = pd->settings.write_type; 18621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->data_block_type = pd->settings.block_mode; 18631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->multi_session = 0; 18651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef PACKET_USE_LS 18671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->link_size = 7; 18681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->ls_v = 1; 18691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 18701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (wp->data_block_type == PACKET_BLOCK_MODE1) { 18721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->session_format = 0; 18731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->subhdr2 = 0x20; 18741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (wp->data_block_type == PACKET_BLOCK_MODE2) { 18751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->session_format = 0x20; 18761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->subhdr2 = 8; 18771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 0 18781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->mcn[0] = 0x80; 18791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy(&wp->mcn[1], PACKET_MCN, sizeof(wp->mcn) - 1); 18801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 18811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 18821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 18831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * paranoia 18841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 18857822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": write mode wrong %d\n", wp->data_block_type); 18861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 18871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->packet_size = cpu_to_be32(pd->settings.size >> 2); 18891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = cgc.cmd[8] = size; 18911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_select(pd, &cgc))) { 18921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 18931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 18941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_print_settings(pd); 18971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 18981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 18991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 19017c613d593370292d1685f5794c743a2323be3a09Peter Osterlund * 1 -- we can write to this track, 0 -- we can't 19021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1903ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlundstatic int pkt_writable_track(struct pktcdvd_device *pd, track_information *ti) 19041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1905ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund switch (pd->mmc3_profile) { 1906ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund case 0x1a: /* DVD+RW */ 1907ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund case 0x12: /* DVD-RAM */ 1908ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund /* The track is always writable on DVD+RW/DVD-RAM */ 1909ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund return 1; 1910ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund default: 1911ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund break; 1912ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund } 19131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1914ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (!ti->packet || !ti->fp) 1915ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund return 0; 19161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 19181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * "good" settings as per Mt Fuji. 19191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1920ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (ti->rt == 0 && ti->blank == 0) 19217c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 19221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1923ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (ti->rt == 0 && ti->blank == 1) 19247c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 19251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1926ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (ti->rt == 1 && ti->blank == 0) 19277c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 19281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19297822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": bad state %d-%d-%d\n", ti->rt, ti->blank, ti->packet); 19307c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 19311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 19321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 19347c613d593370292d1685f5794c743a2323be3a09Peter Osterlund * 1 -- we can write to this disc, 0 -- we can't 19351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 19367c613d593370292d1685f5794c743a2323be3a09Peter Osterlundstatic int pkt_writable_disc(struct pktcdvd_device *pd, disc_information *di) 19371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 19381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (pd->mmc3_profile) { 19391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x0a: /* CD-RW */ 19401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0xffff: /* MMC3 not supported */ 19411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 19421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x1a: /* DVD+RW */ 19431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x13: /* DVD-RW */ 19441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x12: /* DVD-RAM */ 19457c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 19461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 19477822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": Wrong disc profile (%x)\n", pd->mmc3_profile); 19487c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 19491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 19521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * for disc type 0xff we should probably reserve a new track. 19531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * but i'm not sure, should we leave this to user apps? probably. 19541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 19551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->disc_type == 0xff) { 19567822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Unknown disc. No track?\n"); 19577c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 19581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->disc_type != 0x20 && di->disc_type != 0) { 19617822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Wrong disc type (%x)\n", di->disc_type); 19627c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 19631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->erasable == 0) { 19667822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Disc not erasable\n"); 19677c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 19681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->border_status == PACKET_SESSION_RESERVED) { 19717822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Can't write to last track (reserved)\n"); 19727c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 19731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19757c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 19761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 19771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 197805680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_probe_settings(struct pktcdvd_device *pd) 19791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 19801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 19811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[12]; 19821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disc_information di; 19831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds track_information ti; 19841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret, track; 19851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, sizeof(buf), CGC_DATA_READ); 19871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_GET_CONFIGURATION; 19881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = 8; 19891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_generic_packet(pd, &cgc); 19901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->mmc3_profile = ret ? 0xffff : buf[6] << 8 | buf[7]; 19911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&di, 0, sizeof(disc_information)); 19931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&ti, 0, sizeof(track_information)); 19941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_disc_info(pd, &di))) { 19961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("failed get_disc\n"); 19971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 19981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20007c613d593370292d1685f5794c743a2323be3a09Peter Osterlund if (!pkt_writable_disc(pd, &di)) 20019db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 20021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->type = di.erasable ? PACKET_CDRW : PACKET_CDR; 20041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds track = 1; /* (di.last_track_msb << 8) | di.last_track_lsb; */ 20061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_track_info(pd, track, 1, &ti))) { 20077822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": failed get_track\n"); 20081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 20091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2011ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (!pkt_writable_track(pd, &ti)) { 20127822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": can't write to this track\n"); 20139db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 20141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 20171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * we keep packet size in 512 byte units, makes it easier to 20181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * deal with request calculations. 20191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 20201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.size = be32_to_cpu(ti.fixed_packet_size) << 2; 20211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->settings.size == 0) { 20227822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": detected zero packet size!\n"); 2023a460ad62260def15c42130de253d6cfc32528a2fPhillip Susi return -ENXIO; 20241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2025d0272e78eee4dc53c887fd132e9035daf037d423Peter Osterlund if (pd->settings.size > PACKET_MAX_SECTORS) { 20267822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": packet size is too big\n"); 20279db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 2028d0272e78eee4dc53c887fd132e9035daf037d423Peter Osterlund } 20291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.fp = ti.fp; 20301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->offset = (be32_to_cpu(ti.track_start) << 2) & (pd->settings.size - 1); 20311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.nwa_v) { 20331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->nwa = be32_to_cpu(ti.next_writable); 20341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_NWA_VALID, &pd->flags); 20351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 20381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * in theory we could use lra on -RW media as well and just zero 20391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * blocks that haven't been written yet, but in practice that 20401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is just a no-go. we'll use that for -R, naturally. 20411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 20421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.lra_v) { 20431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->lra = be32_to_cpu(ti.last_rec_address); 20441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_LRA_VALID, &pd->flags); 20451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 20461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->lra = 0xffffffff; 20471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_LRA_VALID, &pd->flags); 20481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 20511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * fine for now 20521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 20531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.link_loss = 7; 20541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.write_type = 0; /* packet */ 20551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.track_mode = ti.track_mode; 20561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 20581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * mode1 or mode2 disc 20591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 20601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (ti.data_mode) { 20611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_MODE1: 20621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.block_mode = PACKET_BLOCK_MODE1; 20631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 20641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_MODE2: 20651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.block_mode = PACKET_BLOCK_MODE2; 20661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 20671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 20687822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": unknown data mode\n"); 20699db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 20701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 20721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 20731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 20751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * enable/disable write caching on drive 20761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 207705680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_write_caching(struct pktcdvd_device *pd, 207805680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlund int set) 20791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 20801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 20811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 20821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[64]; 20831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 20841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, sizeof(buf), CGC_DATA_READ); 20861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 20871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = pd->mode_offset + 12; 20881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 20901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * caching mode page might not be there, so quiet this command 20911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 20921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 20931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_sense(pd, &cgc, GPMODE_WCACHING_PAGE, 0))) 20951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 20961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf[pd->mode_offset + 10] |= (!!set << 2); 20981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = cgc.cmd[8] = 2 + ((buf[0] << 8) | (buf[1] & 0xff)); 21001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_mode_select(pd, &cgc); 21011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 21027822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": write caching control failed\n"); 21031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 21041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (!ret && set) 21057822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": enabled write caching on %s\n", pd->name); 21061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 21071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 21081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_lock_door(struct pktcdvd_device *pd, int lockflag) 21101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 21111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 21121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 21141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL; 21151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[4] = lockflag ? 1 : 0; 21161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 21171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 21181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Returns drive maximum write speed 21211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 212205680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_get_max_speed(struct pktcdvd_device *pd, 212305680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlund unsigned *write_speed) 21241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 21251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 21261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 21271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[256+18]; 21281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char *cap_buf; 21291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret, offset; 21301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cap_buf = &buf[sizeof(struct mode_page_header) + pd->mode_offset]; 21321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, sizeof(buf), CGC_DATA_UNKNOWN); 21331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 21341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_mode_sense(pd, &cgc, GPMODE_CAPABILITIES_PAGE, 0); 21361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 21371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = pd->mode_offset + cap_buf[1] + 2 + 21381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(struct mode_page_header); 21391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_mode_sense(pd, &cgc, GPMODE_CAPABILITIES_PAGE, 0); 21401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 21411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 21421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 21431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = 20; /* Obsoleted field, used by older drives */ 21471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cap_buf[1] >= 28) 21481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = 28; /* Current write speed selected */ 21491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cap_buf[1] >= 30) { 21501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* If the drive reports at least one "Logical Unit Write 21511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Speed Performance Descriptor Block", use the information 21521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * in the first block. (contains the highest speed) 21531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 21541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int num_spdb = (cap_buf[30] << 8) + cap_buf[31]; 21551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (num_spdb > 0) 21561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = 34; 21571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *write_speed = (cap_buf[offset] << 8) | cap_buf[offset + 1]; 21601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 21611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 21621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* These tables from cdrecord - I don't have orange book */ 21641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* standard speed CD-RW (1-4x) */ 21651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic char clv_to_speed[16] = { 21661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */ 21671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0, 2, 4, 6, 8, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 21681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 21691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* high speed CD-RW (-10x) */ 21701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic char hs_clv_to_speed[16] = { 21711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */ 21721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0, 2, 4, 6, 10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 21731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 21741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* ultra high speed CD-RW */ 21751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic char us_clv_to_speed[16] = { 21761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */ 21771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0, 2, 4, 8, 0, 0,16, 0,24,32,40,48, 0, 0, 0, 0 21781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 21791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * reads the maximum media speed from ATIP 21821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 218305680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_media_speed(struct pktcdvd_device *pd, 218405680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlund unsigned *speed) 21851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 21861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 21871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 21881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[64]; 21891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int size, st, sp; 21901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 21911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, 2, CGC_DATA_READ); 21931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 21941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_TOC_PMA_ATIP; 21951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 2; 21961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[2] = 4; /* READ ATIP */ 21971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = 2; 21981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_generic_packet(pd, &cgc); 21991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 22001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 22011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 22021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = ((unsigned int) buf[0]<<8) + buf[1] + 2; 22041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (size > sizeof(buf)) 22051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = sizeof(buf); 22061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, size, CGC_DATA_READ); 22081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 22091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_TOC_PMA_ATIP; 22101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 2; 22111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[2] = 4; 22121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = size; 22131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_generic_packet(pd, &cgc); 22141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 22151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 22161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 22171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2219eaa0ff15c30dc9799eb4d12660edb73aeb6d32c5Alexey Dobriyan if (!(buf[6] & 0x40)) { 22207822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Disc type is not CD-RW\n"); 22211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 22221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2223eaa0ff15c30dc9799eb4d12660edb73aeb6d32c5Alexey Dobriyan if (!(buf[6] & 0x4)) { 22247822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": A1 values on media are not valid, maybe not CDRW?\n"); 22251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 22261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds st = (buf[6] >> 3) & 0x7; /* disc sub-type */ 22291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sp = buf[16] & 0xf; /* max speed from ATIP A1 field */ 22311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Info from cdrecord */ 22331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (st) { 22341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0: /* standard speed */ 22351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *speed = clv_to_speed[sp]; 22361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 22371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 1: /* high speed */ 22381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *speed = hs_clv_to_speed[sp]; 22391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 22401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 2: /* ultra high speed */ 22411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *speed = us_clv_to_speed[sp]; 22421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 22431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 22447822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Unknown disc sub-type %d\n",st); 22451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 22461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (*speed) { 22487822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Max. media speed: %d\n",*speed); 22491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 22501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 22517822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Unknown speed %d for sub-type %d\n",sp,st); 22521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 22531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 22551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 225605680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_perform_opc(struct pktcdvd_device *pd) 22571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 22581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 22591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 22601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 22611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22627822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": Performing OPC\n"); 22631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 22651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 22661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.timeout = 60*HZ; 22671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_SEND_OPC; 22681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 1; 22691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 22701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 22711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 22721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 22731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_open_write(struct pktcdvd_device *pd) 22751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 22761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 22771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int write_speed, media_write_speed, read_speed; 22781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_probe_settings(pd))) { 22807822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": %s failed probe\n", pd->name); 22819db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return ret; 22821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_set_write_settings(pd))) { 22857822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": %s failed saving write settings\n", pd->name); 22861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 22871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_write_caching(pd, USE_WCACHING); 22901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_max_speed(pd, &write_speed))) 22921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_speed = 16 * 177; 22931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (pd->mmc3_profile) { 22941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x13: /* DVD-RW */ 22951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x1a: /* DVD+RW */ 22961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x12: /* DVD-RAM */ 22977822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": write speed %ukB/s\n", write_speed); 22981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 22991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 23001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_media_speed(pd, &media_write_speed))) 23011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds media_write_speed = 16; 23021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_speed = min(write_speed, media_write_speed * 177); 23037822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": write speed %ux\n", write_speed / 176); 23041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 23051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_speed = write_speed; 23071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_set_speed(pd, write_speed, read_speed))) { 23097822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": %s couldn't set write speed\n", pd->name); 23101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 23111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->write_speed = write_speed; 23131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->read_speed = read_speed; 23141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_perform_opc(pd))) { 23167822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": %s Optimum Power Calibration failed\n", pd->name); 23171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 23201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 23211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 23231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * called at open time. 23241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2325aeb5d727062a0238a2f96c9c380fbd2be4640c6fAl Virostatic int pkt_open_dev(struct pktcdvd_device *pd, fmode_t write) 23261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 23271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 23281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds long lba; 2329165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboe struct request_queue *q; 23301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 23321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * We need to re-open the cdrom device without O_NONBLOCK to be able 23331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * to read/write from/to it. It is already opened in O_NONBLOCK mode 23341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * so bdget() can't fail. 23351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 23361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdget(pd->bdev->bd_dev); 2337572c48921574dbe6dceb958cf965aa962baefde4Al Viro if ((ret = blkdev_get(pd->bdev, FMODE_READ))) 23381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 23391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23408382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund if ((ret = bd_claim(pd->bdev, pd))) 23418382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund goto out_putdev; 23428382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund 23431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_last_written(pd, &lba))) { 23447822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": pkt_get_last_written failed\n"); 23458382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund goto out_unclaim; 23461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_capacity(pd->disk, lba << 2); 23491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_capacity(pd->bdev->bd_disk, lba << 2); 23501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bd_set_size(pd->bdev, (loff_t)lba << 11); 23511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds q = bdev_get_queue(pd->bdev); 23531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (write) { 23541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_open_write(pd))) 23558382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund goto out_unclaim; 23561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 23571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Some CDRW drives can not handle writes larger than one packet, 23581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * even if the size is a multiple of the packet size. 23591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 23601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(q->queue_lock); 23611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_max_sectors(q, pd->settings.size); 23621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(q->queue_lock); 23631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_WRITABLE, &pd->flags); 23641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 23651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, MAX_SPEED, MAX_SPEED); 23661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds clear_bit(PACKET_WRITABLE, &pd->flags); 23671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_set_segment_merging(pd, q))) 23708382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund goto out_unclaim; 23711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2372e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund if (write) { 2373e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund if (!pkt_grow_pktlist(pd, CONFIG_CDROM_PKTCDVD_BUFFERS)) { 23747822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": not enough memory for buffers\n"); 2375e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund ret = -ENOMEM; 2376e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund goto out_unclaim; 2377e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund } 23787822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": %lukB available on disc\n", lba << 1); 2379e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund } 23801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 23821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23838382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlundout_unclaim: 23848382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund bd_release(pd->bdev); 23851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_putdev: 23869a1c3542768b5a58e45a9216921cd10a3bae1205Al Viro blkdev_put(pd->bdev, FMODE_READ); 23871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 23881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 23891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 23901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 23921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * called when the device is closed. makes sure that the device flushes 23931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the internal cache before we close. 23941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 23951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_release_dev(struct pktcdvd_device *pd, int flush) 23961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 23971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (flush && pkt_flush_cache(pd)) 23987822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": %s not flushing cache\n", pd->name); 23991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_lock_door(pd, 0); 24011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, MAX_SPEED, MAX_SPEED); 24038382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund bd_release(pd->bdev); 24049a1c3542768b5a58e45a9216921cd10a3bae1205Al Viro blkdev_put(pd->bdev, FMODE_READ); 2405e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund 2406e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund pkt_shrink_pktlist(pd); 24071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 24081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct pktcdvd_device *pkt_find_dev_from_minor(int dev_minor) 24101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 24111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev_minor >= MAX_WRITERS) 24121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 24131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_devs[dev_minor]; 24141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 24151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24165e5e007c25009c304af693b7fc49bab8d1d25801Al Virostatic int pkt_open(struct block_device *bdev, fmode_t mode) 24171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 24181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = NULL; 24191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 24201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24217822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": entering open\n"); 24221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24231657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_lock(&ctl_mutex); 24245e5e007c25009c304af693b7fc49bab8d1d25801Al Viro pd = pkt_find_dev_from_minor(MINOR(bdev->bd_dev)); 24251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd) { 24261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENODEV; 24271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 24281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 24291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->refcnt < 0); 24301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->refcnt++; 243246f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund if (pd->refcnt > 1) { 24335e5e007c25009c304af693b7fc49bab8d1d25801Al Viro if ((mode & FMODE_WRITE) && 243446f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund !test_bit(PACKET_WRITABLE, &pd->flags)) { 243546f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund ret = -EBUSY; 243646f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund goto out_dec; 243746f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund } 243846f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund } else { 24395e5e007c25009c304af693b7fc49bab8d1d25801Al Viro ret = pkt_open_dev(pd, mode & FMODE_WRITE); 244001fd9fda2ce462b44bafdac2fe6aacacf23531f2Peter Osterlund if (ret) 24411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_dec; 24421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 24431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * needed here as well, since ext2 (among others) may change 24441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the blocksize at mount time 24451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 24465e5e007c25009c304af693b7fc49bab8d1d25801Al Viro set_blocksize(bdev, CD_FRAMESIZE); 24471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 24481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24491657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_unlock(&ctl_mutex); 24501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 24511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_dec: 24531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->refcnt--; 24541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 24557822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": failed open (%d)\n", ret); 24561657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_unlock(&ctl_mutex); 24571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 24581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 24591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24605e5e007c25009c304af693b7fc49bab8d1d25801Al Virostatic int pkt_close(struct gendisk *disk, fmode_t mode) 24611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 24625e5e007c25009c304af693b7fc49bab8d1d25801Al Viro struct pktcdvd_device *pd = disk->private_data; 24631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = 0; 24641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24651657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_lock(&ctl_mutex); 24661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->refcnt--; 24671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->refcnt < 0); 24681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->refcnt == 0) { 24691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int flush = test_bit(PACKET_WRITABLE, &pd->flags); 24701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_release_dev(pd, flush); 24711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 24721657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_unlock(&ctl_mutex); 24731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 24741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 24751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24776712ecf8f648118c3363c142196418f89a510b90NeilBrownstatic void pkt_end_io_read_cloned(struct bio *bio, int err) 24781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 24791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_stacked_data *psd = bio->bi_private; 24801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = psd->pd; 24811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(bio); 24836712ecf8f648118c3363c142196418f89a510b90NeilBrown bio_endio(psd->bio, err); 24841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_free(psd, psd_pool); 24851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bio_finished(pd); 24861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 24871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2488165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboestatic int pkt_make_request(struct request_queue *q, struct bio *bio) 24891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 24901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd; 24911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char b[BDEVNAME_SIZE]; 24921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t zone; 24931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 24941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int was_empty, blocked_bio; 24951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *node; 24961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd = q->queuedata; 24981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd) { 24997822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": %s incorrect request queue\n", bdevname(bio->bi_bdev, b)); 25001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto end_io; 25011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 25041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Clone READ bios so we can have our own bi_end_io callback. 25051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 25061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio_data_dir(bio) == READ) { 25071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *cloned_bio = bio_clone(bio, GFP_NOIO); 25081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_stacked_data *psd = mempool_alloc(psd_pool, GFP_NOIO); 25091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds psd->pd = pd; 25111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds psd->bio = bio; 25121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cloned_bio->bi_bdev = pd->bdev; 25131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cloned_bio->bi_private = psd; 25141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cloned_bio->bi_end_io = pkt_end_io_read_cloned; 25151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->stats.secs_r += bio->bi_size >> 9; 251646c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund pkt_queue_bio(pd, cloned_bio); 25171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 25181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!test_bit(PACKET_WRITABLE, &pd->flags)) { 25217822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": WRITE for ro device %s (%llu)\n", 25221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->name, (unsigned long long)bio->bi_sector); 25231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto end_io; 25241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio->bi_size || (bio->bi_size % CD_FRAMESIZE)) { 25277822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": wrong bio size\n"); 25281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto end_io; 25291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_bounce(q, &bio); 25321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds zone = ZONE(bio->bi_sector, pd); 25341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_make_request: start = %6llx stop = %6llx\n", 25351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (unsigned long long)bio->bi_sector, 25361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (unsigned long long)(bio->bi_sector + bio_sectors(bio))); 25371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check if we have to split the bio */ 25391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 25401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio_pair *bp; 25411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t last_zone; 25421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int first_sectors; 25431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last_zone = ZONE(bio->bi_sector + bio_sectors(bio) - 1, pd); 25451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (last_zone != zone) { 25461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(last_zone != zone + pd->settings.size); 25471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds first_sectors = last_zone - bio->bi_sector; 25486feef531f55cf4a20fd9eb39f5352e5745203603Denis ChengRq bp = bio_split(bio, first_sectors); 25491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!bp); 25501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_make_request(q, &bp->bio1); 25511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_make_request(q, &bp->bio2); 25521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_pair_release(bp); 25531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 25541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 25581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * If we find a matching packet in state WAITING or READ_WAIT, we can 25591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * just append this bio to that packet. 25601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 25611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 25621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blocked_bio = 0; 25631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 25641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sector == zone) { 25651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 25661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pkt->state == PACKET_WAITING_STATE) || 25671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (pkt->state == PACKET_READ_WAIT_STATE)) { 25681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_add_list_last(bio, &pkt->orig_bios, 25691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &pkt->orig_bios_tail); 25701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->write_size += bio->bi_size / CD_FRAMESIZE; 25711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pkt->write_size >= pkt->frames) && 25721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (pkt->state == PACKET_WAITING_STATE)) { 25731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 25741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 25751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 25771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 25781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 25791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 25801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blocked_bio = 1; 25811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 25831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 25861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25870a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier /* 25880a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier * Test if there is enough room left in the bio work queue 25890a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier * (queue size >= congestion on mark). 25900a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier * If not, wait till the work queue size is below the congestion off mark. 25910a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier */ 25920a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_lock(&pd->lock); 25930a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier if (pd->write_congestion_on > 0 25940a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier && pd->bio_queue_size >= pd->write_congestion_on) { 259583f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier set_bdi_congested(&q->backing_dev_info, WRITE); 25960a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier do { 25970a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_unlock(&pd->lock); 25980a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier congestion_wait(WRITE, HZ); 25990a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_lock(&pd->lock); 26000a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier } while(pd->bio_queue_size > pd->write_congestion_off); 26010a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier } 26020a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_unlock(&pd->lock); 26030a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier 26041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 26051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * No matching packet found. Store the bio in the work queue. 26061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 26071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = mempool_alloc(pd->rb_pool, GFP_NOIO); 26081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node->bio = bio; 26091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->lock); 26101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->bio_queue_size < 0); 26111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds was_empty = (pd->bio_queue_size == 0); 26121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_rbtree_insert(pd, node); 26131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->lock); 26141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 26161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Wake up the worker thread. 26171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 26181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->scan_queue, 1); 26191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (was_empty) { 26201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This wake_up is required for correct operation */ 26211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 26221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (!list_empty(&pd->cdrw.pkt_free_list) && !blocked_bio) { 26231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 26241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This wake up is not required for correct operation, 26251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * but improves performance in some cases. 26261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 26271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 26281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 26291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 26301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsend_io: 26316712ecf8f648118c3363c142196418f89a510b90NeilBrown bio_io_error(bio); 26321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 26331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 26341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2637cc371e66e340f35eed8dc4651c7c18e754c7fb26Alasdair G Kergonstatic int pkt_merge_bvec(struct request_queue *q, struct bvec_merge_data *bmd, 2638cc371e66e340f35eed8dc4651c7c18e754c7fb26Alasdair G Kergon struct bio_vec *bvec) 26391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 26401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = q->queuedata; 2641cc371e66e340f35eed8dc4651c7c18e754c7fb26Alasdair G Kergon sector_t zone = ZONE(bmd->bi_sector, pd); 2642cc371e66e340f35eed8dc4651c7c18e754c7fb26Alasdair G Kergon int used = ((bmd->bi_sector - zone) << 9) + bmd->bi_size; 26431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int remaining = (pd->settings.size << 9) - used; 26441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int remaining2; 26451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 26471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * A bio <= PAGE_SIZE must be allowed. If it crosses a packet 26481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * boundary, pkt_make_request() will split the bio. 26491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2650cc371e66e340f35eed8dc4651c7c18e754c7fb26Alasdair G Kergon remaining2 = PAGE_SIZE - bmd->bi_size; 26511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remaining = max(remaining, remaining2); 26521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(remaining < 0); 26541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return remaining; 26551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 26561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_init_queue(struct pktcdvd_device *pd) 26581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2659165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboe struct request_queue *q = pd->disk->queue; 26601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_make_request(q, pkt_make_request); 2662e1defc4ff0cf57aca6c5e3ff99fa503f5943c1f1Martin K. Petersen blk_queue_logical_block_size(q, CD_FRAMESIZE); 26631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_max_sectors(q, PACKET_MAX_SECTORS); 26641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_merge_bvec(q, pkt_merge_bvec); 26651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds q->queuedata = pd; 26661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 26671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_seq_show(struct seq_file *m, void *p) 26691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 26701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = m->private; 26711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char *msg; 26721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char bdev_buf[BDEVNAME_SIZE]; 26731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int states[PACKET_NUM_STATES]; 26741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "Writer %s mapped to %s:\n", pd->name, 26761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdevname(pd->bdev, bdev_buf)); 26771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nSettings:\n"); 26791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpacket size:\t\t%dkB\n", pd->settings.size / 2); 26801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->settings.write_type == 0) 26821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Packet"; 26831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 26841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Unknown"; 26851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\twrite type:\t\t%s\n", msg); 26861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpacket type:\t\t%s\n", pd->settings.fp ? "Fixed" : "Variable"); 26881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tlink loss:\t\t%d\n", pd->settings.link_loss); 26891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\ttrack mode:\t\t%d\n", pd->settings.track_mode); 26911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->settings.block_mode == PACKET_BLOCK_MODE1) 26931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Mode 1"; 26941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (pd->settings.block_mode == PACKET_BLOCK_MODE2) 26951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Mode 2"; 26961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 26971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Unknown"; 26981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tblock mode:\t\t%s\n", msg); 26991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nStatistics:\n"); 27011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpackets started:\t%lu\n", pd->stats.pkt_started); 27021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpackets ended:\t\t%lu\n", pd->stats.pkt_ended); 27031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\twritten:\t\t%lukB\n", pd->stats.secs_w >> 1); 27041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tread gather:\t\t%lukB\n", pd->stats.secs_rg >> 1); 27051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tread:\t\t\t%lukB\n", pd->stats.secs_r >> 1); 27061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nMisc:\n"); 27081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\treference count:\t%d\n", pd->refcnt); 27091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tflags:\t\t\t0x%lx\n", pd->flags); 27101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tread speed:\t\t%ukB/s\n", pd->read_speed); 27111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\twrite speed:\t\t%ukB/s\n", pd->write_speed); 27121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tstart offset:\t\t%lu\n", pd->offset); 27131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tmode page offset:\t%u\n", pd->mode_offset); 27141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nQueue state:\n"); 27161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tbios queued:\t\t%d\n", pd->bio_queue_size); 27171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tbios pending:\t\t%d\n", atomic_read(&pd->cdrw.pending_bios)); 27181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tcurrent sector:\t\t0x%llx\n", (unsigned long long)pd->current_sector); 27191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_count_states(pd, states); 27211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tstate:\t\t\ti:%d ow:%d rw:%d ww:%d rec:%d fin:%d\n", 27221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[0], states[1], states[2], states[3], states[4], states[5]); 27231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27240a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier seq_printf(m, "\twrite congestion marks:\toff=%d on=%d\n", 27250a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_off, 27260a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_on); 27271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 27281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 27291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_seq_open(struct inode *inode, struct file *file) 27311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 27321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return single_open(file, pkt_seq_show, PDE(inode)->data); 27331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 27341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27352b8693c0617e972fc0b2fd1ebf8de97e15b656c3Arjan van de Venstatic const struct file_operations pkt_proc_fops = { 27361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .open = pkt_seq_open, 27371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .read = seq_read, 27381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .llseek = seq_lseek, 27391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .release = single_release 27401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 27411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_new_dev(struct pktcdvd_device *pd, dev_t dev) 27431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 27441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 27451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = 0; 27461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char b[BDEVNAME_SIZE]; 27471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct block_device *bdev; 27481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->pkt_dev == dev) { 27507822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Recursive setup not allowed\n"); 27511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 27521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 27531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < MAX_WRITERS; i++) { 27541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd2 = pkt_devs[i]; 27551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd2) 27561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 27571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd2->bdev->bd_dev == dev) { 27587822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": %s already setup\n", bdevname(pd2->bdev, b)); 27591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 27601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 27611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd2->pkt_dev == dev) { 27627822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Can't chain pktcdvd devices\n"); 27631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 27641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 27651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 27661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdev = bdget(dev); 27681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bdev) 27691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 2770572c48921574dbe6dceb958cf965aa962baefde4Al Viro ret = blkdev_get(bdev, FMODE_READ | FMODE_NDELAY); 27711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) 27721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 27731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This is safe, since we have a reference from open(). */ 27751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __module_get(THIS_MODULE); 27761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bdev = bdev; 27781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_blocksize(bdev, CD_FRAMESIZE); 27791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_init_queue(pd); 27811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->cdrw.pending_bios, 0); 27831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->cdrw.thread = kthread_run(kcdrwd, pd, "%s", pd->name); 27841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (IS_ERR(pd->cdrw.thread)) { 27857822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": can't start kernel thread\n"); 27861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENOMEM; 2787e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund goto out_mem; 27881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 27891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2790c7705f3449c7edd5c1744871097f93977227afc4Denis V. Lunev proc_create_data(pd->name, 0, pkt_proc, &pkt_proc_fops, pd); 27917822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": writer %s mapped to %s\n", pd->name, bdevname(bdev, b)); 27921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 27931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_mem: 27952cbed8906fd1f3c6cc17cdf8aac1bfad2da7960cAl Viro blkdev_put(bdev, FMODE_READ | FMODE_NDELAY); 27961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This is safe: open() is still holding a reference. */ 27971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds module_put(THIS_MODULE); 27981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 27991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 28001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28015e5e007c25009c304af693b7fc49bab8d1d25801Al Virostatic int pkt_ioctl(struct block_device *bdev, fmode_t mode, unsigned int cmd, unsigned long arg) 28021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 28035e5e007c25009c304af693b7fc49bab8d1d25801Al Viro struct pktcdvd_device *pd = bdev->bd_disk->private_data; 28041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28055e5e007c25009c304af693b7fc49bab8d1d25801Al Viro VPRINTK("pkt_ioctl: cmd %x, dev %d:%d\n", cmd, 28065e5e007c25009c304af693b7fc49bab8d1d25801Al Viro MAJOR(bdev->bd_dev), MINOR(bdev->bd_dev)); 28071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 2809a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro case CDROMEJECT: 2810a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro /* 2811a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro * The door gets locked when the device is opened, so we 2812a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro * have to unlock it or else the eject command fails. 2813a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro */ 2814a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro if (pd->refcnt == 1) 2815a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro pkt_lock_door(pd, 0); 2816a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro /* fallthru */ 28171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 28181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * forward selected CDROM ioctls to CD-ROM, for UDF 28191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 28201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROMMULTISESSION: 28211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROMREADTOCENTRY: 28221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROM_LAST_WRITTEN: 28231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROM_SEND_PACKET: 28241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case SCSI_IOCTL_SEND_COMMAND: 28255e5e007c25009c304af693b7fc49bab8d1d25801Al Viro return __blkdev_driver_ioctl(pd->bdev, mode, cmd, arg); 28261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 28287822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": Unknown ioctl for %s (%x)\n", pd->name, cmd); 28298560c650f340565b720fd57d1f9c99ab216d99d0Linus Torvalds return -ENOTTY; 28301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 28318560c650f340565b720fd57d1f9c99ab216d99d0Linus Torvalds 28328560c650f340565b720fd57d1f9c99ab216d99d0Linus Torvalds return 0; 28331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 28341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_media_changed(struct gendisk *disk) 28361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 28371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = disk->private_data; 28381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct gendisk *attached_disk; 28391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd) 28411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 28421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd->bdev) 28431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 28441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds attached_disk = pd->bdev->bd_disk; 28451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!attached_disk) 28461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 28471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return attached_disk->fops->media_changed(attached_disk); 28481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 28491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct block_device_operations pktcdvd_ops = { 28511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 28525e5e007c25009c304af693b7fc49bab8d1d25801Al Viro .open = pkt_open, 28535e5e007c25009c304af693b7fc49bab8d1d25801Al Viro .release = pkt_close, 28545e5e007c25009c304af693b7fc49bab8d1d25801Al Viro .locked_ioctl = pkt_ioctl, 28551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .media_changed = pkt_media_changed, 28561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 28571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 28591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Set up mapping from pktcdvd device to CD-ROM device. 28601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2861adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierstatic int pkt_setup_dev(dev_t dev, dev_t* pkt_dev) 28621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 28631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int idx; 28641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = -ENOMEM; 28651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd; 28661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct gendisk *disk; 2867adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2868adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 28691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (idx = 0; idx < MAX_WRITERS; idx++) 28711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt_devs[idx]) 28721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 28731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (idx == MAX_WRITERS) { 28747822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": max %d writers supported\n", MAX_WRITERS); 2875adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = -EBUSY; 2876adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out_mutex; 28771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 28781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28791107d2e0352769b9bde6a4877c295b9309cdb877Peter Osterlund pd = kzalloc(sizeof(struct pktcdvd_device), GFP_KERNEL); 28801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd) 2881adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out_mutex; 28821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28830eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson pd->rb_pool = mempool_create_kmalloc_pool(PKT_RB_POOL_SIZE, 28840eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson sizeof(struct pkt_rb_node)); 28851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd->rb_pool) 28861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_mem; 28871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2888e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund INIT_LIST_HEAD(&pd->cdrw.pkt_free_list); 2889e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund INIT_LIST_HEAD(&pd->cdrw.pkt_active_list); 2890e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund spin_lock_init(&pd->cdrw.active_list_lock); 2891e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund 28921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_init(&pd->lock); 28931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_init(&pd->iosched.lock); 28947822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier sprintf(pd->name, DRIVER_NAME"%d", idx); 28951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_waitqueue_head(&pd->wqueue); 28961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bio_queue = RB_ROOT; 28971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28980a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_on = write_congestion_on; 28990a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_off = write_congestion_off; 29000a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier 2901adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier disk = alloc_disk(1); 2902adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier if (!disk) 2903adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out_mem; 2904adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier pd->disk = disk; 2905add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier disk->major = pktdev_major; 29061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->first_minor = idx; 29071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->fops = &pktcdvd_ops; 29081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->flags = GENHD_FL_REMOVABLE; 2909adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier strcpy(disk->disk_name, pd->name); 29101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->private_data = pd; 29111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->queue = blk_alloc_queue(GFP_KERNEL); 29121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!disk->queue) 29131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_mem2; 29141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2915f331c0296f2a9fee0d396a70598b954062603015Tejun Heo pd->pkt_dev = MKDEV(pktdev_major, idx); 29161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_new_dev(pd, dev); 29171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) 29181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_new_dev; 29191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_disk(disk); 2921adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 292232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_dev_new(pd); 292332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_dev_new(pd); 292432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 29251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_devs[idx] = pd; 2926adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier if (pkt_dev) 2927adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier *pkt_dev = pd->pkt_dev; 2928adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2929adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 29301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 29311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_new_dev: 29331312f40e11c57edb5c3250f1b782cef8e3efea82Al Viro blk_cleanup_queue(disk->queue); 29341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_mem2: 29351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds put_disk(disk); 29361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_mem: 29371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->rb_pool) 29381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(pd->rb_pool); 29391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pd); 2940adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierout_mutex: 2941adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 2942adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier printk(DRIVER_NAME": setup of pktcdvd device failed\n"); 29431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 29441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 29451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 29471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Tear down mapping from pktcdvd device to CD-ROM device. 29481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2949adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierstatic int pkt_remove_dev(dev_t pkt_dev) 29501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 29511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd; 29521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int idx; 2953adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier int ret = 0; 2954adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2955adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 29561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (idx = 0; idx < MAX_WRITERS; idx++) { 29581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd = pkt_devs[idx]; 29591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd && (pd->pkt_dev == pkt_dev)) 29601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 29611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 29621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (idx == MAX_WRITERS) { 29637822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": dev not setup\n"); 2964adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = -ENXIO; 2965adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out; 29661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 29671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2968adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier if (pd->refcnt > 0) { 2969adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = -EBUSY; 2970adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out; 2971adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier } 29721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!IS_ERR(pd->cdrw.thread)) 29731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kthread_stop(pd->cdrw.thread); 29741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 297532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_devs[idx] = NULL; 297632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 297732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_dev_remove(pd); 297832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_dev_remove(pd); 297932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 29802cbed8906fd1f3c6cc17cdf8aac1bfad2da7960cAl Viro blkdev_put(pd->bdev, FMODE_READ | FMODE_NDELAY); 29811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remove_proc_entry(pd->name, pkt_proc); 29837822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": writer %s unmapped\n", pd->name); 29841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds del_gendisk(pd->disk); 29861312f40e11c57edb5c3250f1b782cef8e3efea82Al Viro blk_cleanup_queue(pd->disk->queue); 29871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds put_disk(pd->disk); 29881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(pd->rb_pool); 29901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pd); 29911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This is safe: open() is still holding a reference. */ 29931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds module_put(THIS_MODULE); 2994adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2995adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierout: 2996adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 2997adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier return ret; 29981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 29991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_get_status(struct pkt_ctrl_command *ctrl_cmd) 30011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3002adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier struct pktcdvd_device *pd; 3003adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 3004adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 3005adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 3006adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier pd = pkt_find_dev_from_minor(ctrl_cmd->dev_index); 30071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd) { 30081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->dev = new_encode_dev(pd->bdev->bd_dev); 30091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->pkt_dev = new_encode_dev(pd->pkt_dev); 30101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 30111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->dev = 0; 30121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->pkt_dev = 0; 30131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 30141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->num_devices = MAX_WRITERS; 3015adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 3016adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 30171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 30181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30198560c650f340565b720fd57d1f9c99ab216d99d0Linus Torvaldsstatic int pkt_ctl_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg) 30201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 30211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void __user *argp = (void __user *)arg; 30221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_ctrl_command ctrl_cmd; 30231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = 0; 3024adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier dev_t pkt_dev = 0; 30251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cmd != PACKET_CTRL_CMD) 30271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOTTY; 30281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_from_user(&ctrl_cmd, argp, sizeof(struct pkt_ctrl_command))) 30301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 30311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (ctrl_cmd.command) { 30331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PKT_CTRL_CMD_SETUP: 30341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!capable(CAP_SYS_ADMIN)) 30351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EPERM; 3036adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = pkt_setup_dev(new_decode_dev(ctrl_cmd.dev), &pkt_dev); 3037adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ctrl_cmd.pkt_dev = new_encode_dev(pkt_dev); 30381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 30391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PKT_CTRL_CMD_TEARDOWN: 30401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!capable(CAP_SYS_ADMIN)) 30411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EPERM; 3042adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = pkt_remove_dev(new_decode_dev(ctrl_cmd.pkt_dev)); 30431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 30441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PKT_CTRL_CMD_STATUS: 30451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_get_status(&ctrl_cmd); 30461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 30471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 30481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOTTY; 30491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 30501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_to_user(argp, &ctrl_cmd, sizeof(struct pkt_ctrl_command))) 30521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 30531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 30541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 30551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30572b8693c0617e972fc0b2fd1ebf8de97e15b656c3Arjan van de Venstatic const struct file_operations pkt_ctl_fops = { 30588560c650f340565b720fd57d1f9c99ab216d99d0Linus Torvalds .ioctl = pkt_ctl_ioctl, 30591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 30601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 30611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct miscdevice pkt_misc = { 30631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .minor = MISC_DYNAMIC_MINOR, 30647822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier .name = DRIVER_NAME, 30651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .fops = &pkt_ctl_fops 30661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 30671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init pkt_init(void) 30691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 30701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 30711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 307232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier mutex_init(&ctl_mutex); 307332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 30740eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson psd_pool = mempool_create_kmalloc_pool(PSD_POOL_SIZE, 30750eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson sizeof(struct packet_stacked_data)); 30761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!psd_pool) 30771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 30781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3079add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier ret = register_blkdev(pktdev_major, DRIVER_NAME); 30801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret < 0) { 30817822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Unable to register block device\n"); 30821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out2; 30831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3084add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier if (!pktdev_major) 3085add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier pktdev_major = ret; 30861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 308732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier ret = pkt_sysfs_init(); 308832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (ret) 308932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier goto out; 309032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 309132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_init(); 309232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 30931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = misc_register(&pkt_misc); 30941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 30957822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Unable to register misc device\n"); 309632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier goto out_misc; 30971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 30981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3099928b4d8c8963e75bdb133f562b03b07f9aa4844aAlexey Dobriyan pkt_proc = proc_mkdir("driver/"DRIVER_NAME, NULL); 31001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 31011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 31021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 310332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierout_misc: 310432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_cleanup(); 310532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_cleanup(); 31061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 3107add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier unregister_blkdev(pktdev_major, DRIVER_NAME); 31081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout2: 31091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(psd_pool); 31101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 31111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 31121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 31131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit pkt_exit(void) 31141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3115928b4d8c8963e75bdb133f562b03b07f9aa4844aAlexey Dobriyan remove_proc_entry("driver/"DRIVER_NAME, NULL); 31161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds misc_deregister(&pkt_misc); 311732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 311832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_cleanup(); 311932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_cleanup(); 312032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 3121add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier unregister_blkdev(pktdev_major, DRIVER_NAME); 31221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(psd_pool); 31231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 31241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 31251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DESCRIPTION("Packet writing layer for CD/DVD drives"); 31261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Jens Axboe <axboe@suse.de>"); 31271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 31281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 31291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(pkt_init); 31301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(pkt_exit); 3131