pktcdvd.c revision 6712ecf8f648118c3363c142196418f89a510b90
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; 11332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier p = kzalloc(sizeof(*p), GFP_KERNEL); 11432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!p) 11532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return NULL; 11632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier kobject_set_name(&p->kobj, "%s", name); 11732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier p->kobj.parent = parent; 11832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier p->kobj.ktype = ktype; 11932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier p->pd = pd; 12032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (kobject_register(&p->kobj) != 0) 12132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return NULL; 12232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return p; 12332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 12432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* 12532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * remove a pktcdvd kernel object. 12632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier */ 12732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_kobj_remove(struct pktcdvd_kobj *p) 12832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 12932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (p) 13032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier kobject_unregister(&p->kobj); 13132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 13232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* 13332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * default release function for pktcdvd kernel objects. 13432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier */ 13532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_kobj_release(struct kobject *kobj) 13632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 13732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier kfree(to_pktcdvdkobj(kobj)); 13832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 13932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 14032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 14132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/********************************************************** 14232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * 14332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * sysfs interface for pktcdvd 14432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * by (C) 2006 Thomas Maier <balagi@justmail.de> 14532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * 14632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier **********************************************************/ 14732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 14832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier#define DEF_ATTR(_obj,_name,_mode) \ 1497b595756ec1f49e0049a9e01a1298d53a7faaa15Tejun Heo static struct attribute _obj = { .name = _name, .mode = _mode } 15032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 15132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/********************************************************** 15232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier /sys/class/pktcdvd/pktcdvd[0-7]/ 15332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/reset 15432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/packets_started 15532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/packets_finished 15632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/kb_written 15732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/kb_read 15832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/kb_read_gather 15932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier write_queue/size 16032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier write_queue/congestion_off 16132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier write_queue/congestion_on 16232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier **********************************************************/ 16332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 16432694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st1, "reset", 0200); 16532694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st2, "packets_started", 0444); 16632694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st3, "packets_finished", 0444); 16732694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st4, "kb_written", 0444); 16832694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st5, "kb_read", 0444); 16932694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st6, "kb_read_gather", 0444); 17032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 17132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct attribute *kobj_pkt_attrs_stat[] = { 17232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st1, 17332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st2, 17432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st3, 17532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st4, 17632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st5, 17732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st6, 17832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier NULL 17932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 18032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 18132694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_wq1, "size", 0444); 18232694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_wq2, "congestion_off", 0644); 18332694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_wq3, "congestion_on", 0644); 18432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 18532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct attribute *kobj_pkt_attrs_wqueue[] = { 18632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_wq1, 18732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_wq2, 18832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_wq3, 18932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier NULL 19032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 19132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 19232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic ssize_t kobj_pkt_show(struct kobject *kobj, 19332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct attribute *attr, char *data) 19432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 19532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct pktcdvd_device *pd = to_pktcdvdkobj(kobj)->pd; 19632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int n = 0; 19732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int v; 19832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (strcmp(attr->name, "packets_started") == 0) { 19932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.pkt_started); 20032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 20132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "packets_finished") == 0) { 20232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.pkt_ended); 20332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 20432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "kb_written") == 0) { 20532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.secs_w >> 1); 20632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 20732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "kb_read") == 0) { 20832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.secs_r >> 1); 20932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 21032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "kb_read_gather") == 0) { 21132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.secs_rg >> 1); 21232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 21332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "size") == 0) { 21432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 21532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier v = pd->bio_queue_size; 21632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 21732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%d\n", v); 21832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 21932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_off") == 0) { 22032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 22132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier v = pd->write_congestion_off; 22232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 22332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%d\n", v); 22432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 22532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_on") == 0) { 22632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 22732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier v = pd->write_congestion_on; 22832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 22932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%d\n", v); 23032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 23132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return n; 23232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 23332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 23432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void init_write_congestion_marks(int* lo, int* hi) 23532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 23632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (*hi > 0) { 23732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *hi = max(*hi, 500); 23832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *hi = min(*hi, 1000000); 23932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (*lo <= 0) 24032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = *hi - 100; 24132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier else { 24232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = min(*lo, *hi - 100); 24332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = max(*lo, 100); 24432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 24532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else { 24632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *hi = -1; 24732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = -1; 24832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 24932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 25032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 25132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic ssize_t kobj_pkt_store(struct kobject *kobj, 25232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct attribute *attr, 25332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier const char *data, size_t len) 25432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 25532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct pktcdvd_device *pd = to_pktcdvdkobj(kobj)->pd; 25632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int val; 25732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 25883f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier if (strcmp(attr->name, "reset") == 0 && len > 0) { 25932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.pkt_started = 0; 26032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.pkt_ended = 0; 26132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.secs_w = 0; 26232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.secs_rg = 0; 26332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.secs_r = 0; 26432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 26532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_off") == 0 26683f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier && sscanf(data, "%d", &val) == 1) { 26732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 26832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->write_congestion_off = val; 26932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier init_write_congestion_marks(&pd->write_congestion_off, 27032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &pd->write_congestion_on); 27132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 27232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 27332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_on") == 0 27483f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier && sscanf(data, "%d", &val) == 1) { 27532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 27632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->write_congestion_on = val; 27732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier init_write_congestion_marks(&pd->write_congestion_off, 27832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &pd->write_congestion_on); 27932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 28032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 28132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return len; 28232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 28332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 28432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct sysfs_ops kobj_pkt_ops = { 28532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .show = kobj_pkt_show, 28632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .store = kobj_pkt_store 28732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 28832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct kobj_type kobj_pkt_type_stat = { 28932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .release = pkt_kobj_release, 29032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .sysfs_ops = &kobj_pkt_ops, 29132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .default_attrs = kobj_pkt_attrs_stat 29232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 29332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct kobj_type kobj_pkt_type_wqueue = { 29432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .release = pkt_kobj_release, 29532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .sysfs_ops = &kobj_pkt_ops, 29632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .default_attrs = kobj_pkt_attrs_wqueue 29732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 29832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 29932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_sysfs_dev_new(struct pktcdvd_device *pd) 30032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 30132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (class_pktcdvd) { 30232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->clsdev = class_device_create(class_pktcdvd, 30332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier NULL, pd->pkt_dev, 30432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier NULL, "%s", pd->name); 30532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (IS_ERR(pd->clsdev)) 30632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->clsdev = NULL; 30732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 30832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (pd->clsdev) { 30932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->kobj_stat = pkt_kobj_create(pd, "stat", 31032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &pd->clsdev->kobj, 31132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_type_stat); 31232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->kobj_wqueue = pkt_kobj_create(pd, "write_queue", 31332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &pd->clsdev->kobj, 31432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_type_wqueue); 31532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 31632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 31732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 31832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_sysfs_dev_remove(struct pktcdvd_device *pd) 31932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 32032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_kobj_remove(pd->kobj_stat); 32132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_kobj_remove(pd->kobj_wqueue); 32232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (class_pktcdvd) 32332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_device_destroy(class_pktcdvd, pd->pkt_dev); 32432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 32532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 32632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 32732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/******************************************************************** 32832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier /sys/class/pktcdvd/ 32932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier add map block device 33032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier remove unmap packet dev 33132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier device_map show mappings 33232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *******************************************************************/ 33332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 33432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void class_pktcdvd_release(struct class *cls) 33532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 33632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier kfree(cls); 33732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 33832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic ssize_t class_pktcdvd_show_map(struct class *c, char *data) 33932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 34032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int n = 0; 34132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int idx; 34232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 34332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier for (idx = 0; idx < MAX_WRITERS; idx++) { 34432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct pktcdvd_device *pd = pkt_devs[idx]; 34532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!pd) 34632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier continue; 34732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n += sprintf(data+n, "%s %u:%u %u:%u\n", 34832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->name, 34932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier MAJOR(pd->pkt_dev), MINOR(pd->pkt_dev), 35032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier MAJOR(pd->bdev->bd_dev), 35132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier MINOR(pd->bdev->bd_dev)); 35232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 35332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier mutex_unlock(&ctl_mutex); 35432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return n; 35532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 35632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 35732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic ssize_t class_pktcdvd_store_add(struct class *c, const char *buf, 35832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier size_t count) 35932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 36032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier unsigned int major, minor; 36183f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier if (sscanf(buf, "%u:%u", &major, &minor) == 2) { 36232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_setup_dev(MKDEV(major, minor), NULL); 36332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return count; 36432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 36532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return -EINVAL; 36632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 36732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 36832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic ssize_t class_pktcdvd_store_remove(struct class *c, const char *buf, 36932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier size_t count) 37032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 37132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier unsigned int major, minor; 37283f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier if (sscanf(buf, "%u:%u", &major, &minor) == 2) { 37332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_remove_dev(MKDEV(major, minor)); 37432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return count; 37532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 37632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return -EINVAL; 37732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 37832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 37932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct class_attribute class_pktcdvd_attrs[] = { 38032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR(add, 0200, NULL, class_pktcdvd_store_add), 38132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR(remove, 0200, NULL, class_pktcdvd_store_remove), 38232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR(device_map, 0444, class_pktcdvd_show_map, NULL), 38332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR_NULL 38432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 38532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 38632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 38732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_sysfs_init(void) 38832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 38932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int ret = 0; 39032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 39132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier /* 39232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * create control files in sysfs 39332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * /sys/class/pktcdvd/... 39432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier */ 39532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd = kzalloc(sizeof(*class_pktcdvd), GFP_KERNEL); 39632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!class_pktcdvd) 39732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return -ENOMEM; 39832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->name = DRIVER_NAME; 39932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->owner = THIS_MODULE; 40032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->class_release = class_pktcdvd_release; 40132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->class_attrs = class_pktcdvd_attrs; 40232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier ret = class_register(class_pktcdvd); 40332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (ret) { 40432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier kfree(class_pktcdvd); 40532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd = NULL; 40632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier printk(DRIVER_NAME": failed to create class pktcdvd\n"); 40732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return ret; 40832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 40932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return 0; 41032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 41132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 41232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_sysfs_cleanup(void) 41332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 41432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (class_pktcdvd) 41532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_destroy(class_pktcdvd); 41632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd = NULL; 41732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 41832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 41932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/******************************************************************** 42032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier entries in debugfs 42132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 42232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier /debugfs/pktcdvd[0-7]/ 42332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier info 42432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 42532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *******************************************************************/ 42632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 42732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_debugfs_seq_show(struct seq_file *m, void *p) 42832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 42932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return pkt_seq_show(m, p); 43032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 43132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 43232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_debugfs_fops_open(struct inode *inode, struct file *file) 43332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 43432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return single_open(file, pkt_debugfs_seq_show, inode->i_private); 43532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 43632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 4372b8693c0617e972fc0b2fd1ebf8de97e15b656c3Arjan van de Venstatic const struct file_operations debug_fops = { 43832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .open = pkt_debugfs_fops_open, 43932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .read = seq_read, 44032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .llseek = seq_lseek, 44132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .release = single_release, 44232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .owner = THIS_MODULE, 44332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 44432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 44532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_dev_new(struct pktcdvd_device *pd) 44632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 44732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!pkt_debugfs_root) 44832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 44932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_f_info = NULL; 45032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_d_root = debugfs_create_dir(pd->name, pkt_debugfs_root); 45132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (IS_ERR(pd->dfs_d_root)) { 45232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_d_root = NULL; 45332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 45432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 45532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_f_info = debugfs_create_file("info", S_IRUGO, 45632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_d_root, pd, &debug_fops); 45732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (IS_ERR(pd->dfs_f_info)) { 45832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_f_info = NULL; 45932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 46032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 46132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 46232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 46332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_dev_remove(struct pktcdvd_device *pd) 46432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 46532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!pkt_debugfs_root) 46632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 46732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (pd->dfs_f_info) 46832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier debugfs_remove(pd->dfs_f_info); 46932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_f_info = NULL; 47032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (pd->dfs_d_root) 47132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier debugfs_remove(pd->dfs_d_root); 47232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_d_root = NULL; 47332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 47432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 47532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_init(void) 47632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 47732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_root = debugfs_create_dir(DRIVER_NAME, NULL); 47832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (IS_ERR(pkt_debugfs_root)) { 47932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_root = NULL; 48032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 48132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 48232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 48332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 48432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_cleanup(void) 48532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 48632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!pkt_debugfs_root) 48732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 48832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier debugfs_remove(pkt_debugfs_root); 48932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_root = NULL; 49032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 49132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 49232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* ----------------------------------------------------------*/ 49332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_bio_finished(struct pktcdvd_device *pd) 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(atomic_read(&pd->cdrw.pending_bios) <= 0); 4981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_dec_and_test(&pd->cdrw.pending_bios)) { 4997822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": queue empty\n"); 5001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->iosched.attention, 1); 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_bio_destructor(struct bio *bio) 5061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(bio->bi_io_vec); 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(bio); 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct bio *pkt_bio_alloc(int nr_iovecs) 5121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio_vec *bvl = NULL; 5141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio; 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = kmalloc(sizeof(struct bio), GFP_KERNEL); 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio) 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_bio; 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_init(bio); 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5211107d2e0352769b9bde6a4877c295b9309cdb877Peter Osterlund bvl = kcalloc(nr_iovecs, sizeof(struct bio_vec), GFP_KERNEL); 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bvl) 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_bvl; 5241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_max_vecs = nr_iovecs; 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_io_vec = bvl; 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_destructor = pkt_bio_destructor; 5281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return bio; 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds no_bvl: 5321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(bio); 5331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds no_bio: 5341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 5351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 5381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Allocate a packet_data struct 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 540e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlundstatic struct packet_data *pkt_alloc_packet_data(int frames) 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5451107d2e0352769b9bde6a4877c295b9309cdb877Peter Osterlund pkt = kzalloc(sizeof(struct packet_data), GFP_KERNEL); 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt) 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_pkt; 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 549e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund pkt->frames = frames; 550e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund pkt->w_bio = pkt_bio_alloc(frames); 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt->w_bio) 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_bio; 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 554e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames / FRAMES_PER_PAGE; i++) { 5551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->pages[i] = alloc_page(GFP_KERNEL|__GFP_ZERO); 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt->pages[i]) 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_page; 5581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_init(&pkt->lock); 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 562e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames; i++) { 5631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio = pkt_bio_alloc(1); 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio) 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_rd_bio; 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->r_bios[i] = bio; 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt; 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_rd_bio: 572e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames; i++) { 5731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio = pkt->r_bios[i]; 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio) 5751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(bio); 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_page: 579e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames / FRAMES_PER_PAGE; i++) 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->pages[i]) 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __free_page(pkt->pages[i]); 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(pkt->w_bio); 5831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_bio: 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pkt); 5851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_pkt: 5861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 5871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Free a packet_data struct 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_free_packet_data(struct packet_data *pkt) 5931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 5951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 596e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < pkt->frames; i++) { 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio = pkt->r_bios[i]; 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio) 5991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(bio); 6001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 601e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < pkt->frames / FRAMES_PER_PAGE; i++) 6021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __free_page(pkt->pages[i]); 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(pkt->w_bio); 6041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pkt); 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_shrink_pktlist(struct pktcdvd_device *pd) 6081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt, *next; 6101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!list_empty(&pd->cdrw.pkt_active_list)); 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry_safe(pkt, next, &pd->cdrw.pkt_free_list, list) { 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_free_packet_data(pkt); 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 616e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund INIT_LIST_HEAD(&pd->cdrw.pkt_free_list); 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_grow_pktlist(struct pktcdvd_device *pd, int nr_packets) 6201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 623e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund BUG_ON(!list_empty(&pd->cdrw.pkt_free_list)); 624e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (nr_packets > 0) { 626e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund pkt = pkt_alloc_packet_data(pd->settings.size >> 2); 6271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt) { 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_shrink_pktlist(pd); 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->id = nr_packets; 6321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->pd = pd; 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add(&pkt->list, &pd->cdrw.pkt_free_list); 6341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds nr_packets--; 6351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 6371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline struct pkt_rb_node *pkt_rbtree_next(struct pkt_rb_node *node) 6401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *n = rb_next(&node->rb_node); 6421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!n) 6431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 6441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rb_entry(n, struct pkt_rb_node, rb_node); 6451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 647ac893963030ad70e528dc23270d499d650546a38Peter Osterlundstatic void pkt_rbtree_erase(struct pktcdvd_device *pd, struct pkt_rb_node *node) 6481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rb_erase(&node->rb_node, &pd->bio_queue); 6501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_free(node, pd->rb_pool); 6511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bio_queue_size--; 6521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->bio_queue_size < 0); 6531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 6561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Find the first node in the pd->bio_queue rb tree with a starting sector >= s. 6571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 6581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct pkt_rb_node *pkt_rbtree_find(struct pktcdvd_device *pd, sector_t s) 6591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *n = pd->bio_queue.rb_node; 6611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *next; 6621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *tmp; 6631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!n) { 6651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->bio_queue_size > 0); 6661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 6671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 6701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = rb_entry(n, struct pkt_rb_node, rb_node); 6711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (s <= tmp->bio->bi_sector) 6721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds next = n->rb_left; 6731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 6741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds next = n->rb_right; 6751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!next) 6761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds n = next; 6781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (s > tmp->bio->bi_sector) { 6811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = pkt_rbtree_next(tmp); 6821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!tmp) 6831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 6841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(s > tmp->bio->bi_sector); 6861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return tmp; 6871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 6901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Insert a node into the pd->bio_queue rb tree. 6911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 6921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_rbtree_insert(struct pktcdvd_device *pd, struct pkt_rb_node *node) 6931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node **p = &pd->bio_queue.rb_node; 6951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *parent = NULL; 6961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t s = node->bio->bi_sector; 6971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *tmp; 6981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (*p) { 7001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds parent = *p; 7011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = rb_entry(parent, struct pkt_rb_node, rb_node); 7021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (s < tmp->bio->bi_sector) 7031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = &(*p)->rb_left; 7041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 7051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = &(*p)->rb_right; 7061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rb_link_node(&node->rb_node, parent, p); 7081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rb_insert_color(&node->rb_node, &pd->bio_queue); 7091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bio_queue_size++; 7101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Add a bio to a single linked list defined by its head and tail pointers. 7141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 715ac893963030ad70e528dc23270d499d650546a38Peter Osterlundstatic void pkt_add_list_last(struct bio *bio, struct bio **list_head, struct bio **list_tail) 7161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_next = NULL; 7181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (*list_tail) { 7191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON((*list_head) == NULL); 7201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (*list_tail)->bi_next = bio; 7211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (*list_tail) = bio; 7221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 7231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON((*list_head) != NULL); 7241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (*list_head) = bio; 7251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (*list_tail) = bio; 7261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Remove and return the first bio from a single linked list defined by its 7311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * head and tail pointers. 7321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline struct bio *pkt_get_list_first(struct bio **list_head, struct bio **list_tail) 7341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio; 7361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (*list_head == NULL) 7381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 7391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = *list_head; 7411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *list_head = bio->bi_next; 7421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (*list_head == NULL) 7431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *list_tail = NULL; 7441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_next = NULL; 7461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return bio; 7471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Send a packet_command to the underlying block device and 7511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * wait for completion. 7521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_generic_packet(struct pktcdvd_device *pd, struct packet_command *cgc) 7541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 755165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboe struct request_queue *q = bdev_get_queue(pd->bdev); 7561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request *rq; 757406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig int ret = 0; 758406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig 759406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig rq = blk_get_request(q, (cgc->data_direction == CGC_DATA_WRITE) ? 760406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig WRITE : READ, __GFP_WAIT); 761406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig 762406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig if (cgc->buflen) { 763406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig if (blk_rq_map_kern(q, rq, cgc->buffer, cgc->buflen, __GFP_WAIT)) 764406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig goto out; 765406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig } 7661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 76791e4ee381d23ef67196a03924485aeceb32d6753Gerhard Dirschl rq->cmd_len = COMMAND_SIZE(cgc->cmd[0]); 768406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig memcpy(rq->cmd, cgc->cmd, CDROM_PACKET_SIZE); 769406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig if (sizeof(rq->cmd) > CDROM_PACKET_SIZE) 770406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig memset(rq->cmd + CDROM_PACKET_SIZE, 0, sizeof(rq->cmd) - CDROM_PACKET_SIZE); 7711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rq->timeout = 60*HZ; 7734aff5e2333c9a1609662f2091f55c3f6fffdad36Jens Axboe rq->cmd_type = REQ_TYPE_BLOCK_PC; 7744aff5e2333c9a1609662f2091f55c3f6fffdad36Jens Axboe rq->cmd_flags |= REQ_HARDBARRIER; 7751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cgc->quiet) 7764aff5e2333c9a1609662f2091f55c3f6fffdad36Jens Axboe rq->cmd_flags |= REQ_QUIET; 7771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 778406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig blk_execute_rq(rq->q, pd->bdev->bd_disk, rq, 0); 779cbc31a475a7f7748bd0a4e536533868e7cff8645Andrew Morton if (rq->errors) 780cbc31a475a7f7748bd0a4e536533868e7cff8645Andrew Morton ret = -EIO; 781406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwigout: 7821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_put_request(rq); 783406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig return ret; 7841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * A generic sense dump / resolve mechanism should be implemented across 7881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * all ATAPI + SCSI devices. 7891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_dump_sense(struct packet_command *cgc) 7911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds static char *info[9] = { "No sense", "Recovered error", "Not ready", 7931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "Medium error", "Hardware error", "Illegal request", 7941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "Unit attention", "Data protect", "Blank check" }; 7951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 7961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense *sense = cgc->sense; 7971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7987822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME":"); 7991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < CDROM_PACKET_SIZE; i++) 8001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(" %02x", cgc->cmd[i]); 8011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(" - "); 8021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sense == NULL) { 8041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("no sense\n"); 8051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 8061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("sense %02x.%02x.%02x", sense->sense_key, sense->asc, sense->ascq); 8091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sense->sense_key > 8) { 8111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(" (INVALID)\n"); 8121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 8131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(" (%s)\n", info[sense->sense_key]); 8161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 8191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * flush the drive cache to media 8201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 8211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_flush_cache(struct pktcdvd_device *pd) 8221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 8241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 8261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_FLUSH_CACHE; 8271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 8281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 8301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the IMMED bit -- we default to not setting it, although that 8311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * would allow a much faster close, this is safer 8321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 8331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 0 8341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 1 << 1; 8351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 8361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 8371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 8401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * speed is given as the normal factor, e.g. 4 for 4x 8411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 8421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_set_speed(struct pktcdvd_device *pd, unsigned write_speed, unsigned read_speed) 8431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 8451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 8461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 8471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 8491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 8501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_SET_SPEED; 8511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[2] = (read_speed >> 8) & 0xff; 8521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[3] = read_speed & 0xff; 8531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[4] = (write_speed >> 8) & 0xff; 8541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[5] = write_speed & 0xff; 8551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 8571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 8581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 8601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 8631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Queue a bio for processing by the low-level CD device. Must be called 8641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * from process context. 8651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 86646c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlundstatic void pkt_queue_bio(struct pktcdvd_device *pd, struct bio *bio) 8671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->iosched.lock); 8691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio_data_dir(bio) == READ) { 8701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_add_list_last(bio, &pd->iosched.read_queue, 8711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &pd->iosched.read_queue_tail); 8721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 8731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_add_list_last(bio, &pd->iosched.write_queue, 8741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &pd->iosched.write_queue_tail); 8751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->iosched.lock); 8771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->iosched.attention, 1); 8791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 8801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 8831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Process the queued read/write requests. This function handles special 8841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * requirements for CDRW drives: 8851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * - A cache flush command must be inserted before a read request if the 8861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * previous request was a write. 88746c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * - Switching between reading and writing is slow, so don't do it more often 8881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * than necessary. 88946c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * - Optimize for throughput at the expense of latency. This means that streaming 89046c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * writes will never be interrupted by a read, but if the drive has to seek 89146c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * before the next write, switch to reading instead if there are any pending 89246c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * read requests. 8931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * - Set the read speed according to current usage pattern. When only reading 8941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * from the device, it's best to use the highest possible read speed, but 8951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * when switching often between reading and writing, it's better to have the 8961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * same read and write speeds. 8971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 8981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_iosched_process_queue(struct pktcdvd_device *pd) 8991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->iosched.attention) == 0) 9021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 9031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->iosched.attention, 0); 9041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 9061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio; 90746c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund int reads_queued, writes_queued; 9081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->iosched.lock); 9101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds reads_queued = (pd->iosched.read_queue != NULL); 9111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds writes_queued = (pd->iosched.write_queue != NULL); 9121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->iosched.lock); 9131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!reads_queued && !writes_queued) 9151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 9161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->iosched.writing) { 91846c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund int need_write_seek = 1; 91946c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund spin_lock(&pd->iosched.lock); 92046c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund bio = pd->iosched.write_queue; 92146c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund spin_unlock(&pd->iosched.lock); 92246c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund if (bio && (bio->bi_sector == pd->iosched.last_write)) 92346c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund need_write_seek = 0; 92446c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund if (need_write_seek && reads_queued) { 9251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->cdrw.pending_bios) > 0) { 9267822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": write, waiting\n"); 9271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 9281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_flush_cache(pd); 9301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->iosched.writing = 0; 9311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 9331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!reads_queued && writes_queued) { 9341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->cdrw.pending_bios) > 0) { 9357822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": read, waiting\n"); 9361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 9371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->iosched.writing = 1; 9391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->iosched.lock); 9431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->iosched.writing) { 9441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = pkt_get_list_first(&pd->iosched.write_queue, 9451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &pd->iosched.write_queue_tail); 9461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 9471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = pkt_get_list_first(&pd->iosched.read_queue, 9481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &pd->iosched.read_queue_tail); 9491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->iosched.lock); 9511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio) 9531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 9541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio_data_dir(bio) == READ) 9561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->iosched.successive_reads += bio->bi_size >> 10; 95746c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund else { 9581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->iosched.successive_reads = 0; 95946c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund pd->iosched.last_write = bio->bi_sector + bio_sectors(bio); 96046c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund } 9611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->iosched.successive_reads >= HI_SPEED_SWITCH) { 9621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->read_speed == pd->write_speed) { 9631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->read_speed = MAX_SPEED; 9641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, pd->write_speed, pd->read_speed); 9651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 9671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->read_speed != pd->write_speed) { 9681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->read_speed = pd->write_speed; 9691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, pd->write_speed, pd->read_speed); 9701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pd->cdrw.pending_bios); 9741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds generic_make_request(bio); 9751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 9791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Special care is needed if the underlying block device has a small 9801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * max_phys_segments value. 9811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 982165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboestatic int pkt_set_segment_merging(struct pktcdvd_device *pd, struct request_queue *q) 9831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pd->settings.size << 9) / CD_FRAMESIZE <= q->max_phys_segments) { 9851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 9861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * The cdrom device can handle one segment/frame 9871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds clear_bit(PACKET_MERGE_SEGS, &pd->flags); 9891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 9901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if ((pd->settings.size << 9) / PAGE_SIZE <= q->max_phys_segments) { 9911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 9921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * We can handle this case at the expense of some extra memory 9931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * copies during write operations 9941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_MERGE_SEGS, &pd->flags); 9961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 9971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 9987822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": cdrom max_phys_segments too small\n"); 9991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 10001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 10041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copy CD_FRAMESIZE bytes from src_bio into a destination page 10051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 10061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_copy_bio_data(struct bio *src_bio, int seg, int offs, struct page *dst_page, int dst_offs) 10071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int copy_size = CD_FRAMESIZE; 10091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (copy_size > 0) { 10111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio_vec *src_bvl = bio_iovec_idx(src_bio, seg); 10121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void *vfrom = kmap_atomic(src_bvl->bv_page, KM_USER0) + 10131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds src_bvl->bv_offset + offs; 10141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void *vto = page_address(dst_page) + dst_offs; 10151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int len = min_t(int, copy_size, src_bvl->bv_len - offs); 10161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(len < 0); 10181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy(vto, vfrom, len); 10191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kunmap_atomic(vfrom, KM_USER0); 10201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seg++; 10221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offs = 0; 10231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dst_offs += len; 10241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds copy_size -= len; 10251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 10291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copy all data for this packet to pkt->pages[], so that 10301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * a) The number of required segments for the write bio is minimized, which 10311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is necessary for some scsi controllers. 10321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * b) The data can be used as cache to avoid read requests if we receive a 10331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * new write request for the same zone. 10341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 10357277232374680595cdbc774fd246b206f56db015Peter Osterlundstatic void pkt_make_local_copy(struct packet_data *pkt, struct bio_vec *bvec) 10361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int f, p, offs; 10381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Copy all data to pkt->pages[] */ 10401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = 0; 10411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offs = 0; 10421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = 0; f < pkt->frames; f++) { 10437277232374680595cdbc774fd246b206f56db015Peter Osterlund if (bvec[f].bv_page != pkt->pages[p]) { 10447277232374680595cdbc774fd246b206f56db015Peter Osterlund void *vfrom = kmap_atomic(bvec[f].bv_page, KM_USER0) + bvec[f].bv_offset; 10451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void *vto = page_address(pkt->pages[p]) + offs; 10461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy(vto, vfrom, CD_FRAMESIZE); 10471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kunmap_atomic(vfrom, KM_USER0); 10487277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_page = pkt->pages[p]; 10497277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_offset = offs; 10501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 10517277232374680595cdbc774fd246b206f56db015Peter Osterlund BUG_ON(bvec[f].bv_offset != offs); 10521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offs += CD_FRAMESIZE; 10541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (offs >= PAGE_SIZE) { 10551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offs = 0; 10561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p++; 10571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10616712ecf8f648118c3363c142196418f89a510b90NeilBrownstatic void pkt_end_io_read(struct bio *bio, int err) 10621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt = bio->bi_private; 10641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = pkt->pd; 10651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!pd); 10661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_end_io_read: bio=%p sec0=%llx sec=%llx err=%d\n", bio, 10681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (unsigned long long)pkt->sector, (unsigned long long)bio->bi_sector, err); 10691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err) 10711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->io_errors); 10721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_dec_and_test(&pkt->io_wait)) { 10731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 10741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 10751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bio_finished(pd); 10771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10796712ecf8f648118c3363c142196418f89a510b90NeilBrownstatic void pkt_end_io_packet_write(struct bio *bio, int err) 10801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt = bio->bi_private; 10821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = pkt->pd; 10831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!pd); 10841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_end_io_packet_write: id=%d, err=%d\n", pkt->id, err); 10861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->stats.pkt_ended++; 10881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bio_finished(pd); 10901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_dec(&pkt->io_wait); 10911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 10921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 10931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 10961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Schedule reads for the holes in a packet 10971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 10981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_gather_data(struct pktcdvd_device *pd, struct packet_data *pkt) 10991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int frames_read = 0; 11011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio; 11021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int f; 11031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char written[PACKET_MAX_SIZE]; 11041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!pkt->orig_bios); 11061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->io_wait, 0); 11081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->io_errors, 0); 11091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 11111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Figure out which frames we need to read before we can write. 11121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 11131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(written, 0, sizeof(written)); 11141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 11151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (bio = pkt->orig_bios; bio; bio = bio->bi_next) { 11161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int first_frame = (bio->bi_sector - pkt->sector) / (CD_FRAMESIZE >> 9); 11171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int num_frames = bio->bi_size / CD_FRAMESIZE; 111806e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund pd->stats.secs_w += num_frames * (CD_FRAMESIZE >> 9); 11191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(first_frame < 0); 11201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(first_frame + num_frames > pkt->frames); 11211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = first_frame; f < first_frame + num_frames; f++) 11221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds written[f] = 1; 11231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 11251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 112606e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund if (pkt->cache_valid) { 112706e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund VPRINTK("pkt_gather_data: zone %llx cached\n", 112806e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund (unsigned long long)pkt->sector); 112906e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund goto out_account; 113006e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund } 113106e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund 11321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 11331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Schedule reads for missing parts of the packet. 11341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 11351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = 0; f < pkt->frames; f++) { 11361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int p, offset; 11371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (written[f]) 11381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 11391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = pkt->r_bios[f]; 11401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_init(bio); 11411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_max_vecs = 1; 11421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_sector = pkt->sector + f * (CD_FRAMESIZE >> 9); 11431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_bdev = pd->bdev; 11441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_end_io = pkt_end_io_read; 11451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_private = pkt; 11461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = (f * CD_FRAMESIZE) / PAGE_SIZE; 11481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = (f * CD_FRAMESIZE) % PAGE_SIZE; 11491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_gather_data: Adding frame %d, page:%p offs:%d\n", 11501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds f, pkt->pages[p], offset); 11511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio_add_page(bio, pkt->pages[p], CD_FRAMESIZE, offset)) 11521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG(); 11531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->io_wait); 11551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_rw = READ; 115646c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund pkt_queue_bio(pd, bio); 11571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_read++; 11581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_account: 11611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_gather_data: need %d frames for zone %llx\n", 11621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_read, (unsigned long long)pkt->sector); 11631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->stats.pkt_started++; 11641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->stats.secs_rg += frames_read * (CD_FRAMESIZE >> 9); 11651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 11681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Find a packet matching zone, or the least recently used packet if 11691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * there is no match. 11701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 11711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct packet_data *pkt_get_packet_data(struct pktcdvd_device *pd, int zone) 11721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 11741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_free_list, list) { 11761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sector == zone || pkt->list.next == &pd->cdrw.pkt_free_list) { 11771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_del_init(&pkt->list); 11781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sector != zone) 11791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 0; 1180610827dee82731c7be5a135d750d194ac56881a9Peter Osterlund return pkt; 11811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1183610827dee82731c7be5a135d750d194ac56881a9Peter Osterlund BUG(); 1184610827dee82731c7be5a135d750d194ac56881a9Peter Osterlund return NULL; 11851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_put_packet_data(struct pktcdvd_device *pd, struct packet_data *pkt) 11881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->cache_valid) { 11901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add(&pkt->list, &pd->cdrw.pkt_free_list); 11911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 11921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add_tail(&pkt->list, &pd->cdrw.pkt_free_list); 11931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 11971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * recover a failed write, query for relocation if possible 11981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 11991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * returns 1 if recovery is possible, or 0 if not 12001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 12011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 12021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_start_recovery(struct packet_data *pkt) 12031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 12041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 12051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * FIXME. We need help from the file system to implement 12061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * recovery handling. 12071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 12081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 12091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 0 12101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request *rq = pkt->rq; 12111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = rq->rq_disk->private_data; 12121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct block_device *pkt_bdev; 12131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct super_block *sb = NULL; 12141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long old_block, new_block; 12151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t new_sector; 12161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bdev = bdget(kdev_t_to_nr(pd->pkt_dev)); 12181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt_bdev) { 12191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sb = get_super(pkt_bdev); 12201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdput(pkt_bdev); 12211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!sb) 12241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 12251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!sb->s_op || !sb->s_op->relocate_blocks) 12271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 12281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds old_block = pkt->sector / (CD_FRAMESIZE >> 9); 12301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sb->s_op->relocate_blocks(sb, old_block, &new_block)) 12311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 12321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds new_sector = new_block * (CD_FRAMESIZE >> 9); 12341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sector = new_sector; 12351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->bio->bi_sector = new_sector; 12371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->bio->bi_next = NULL; 12381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->bio->bi_flags = 1 << BIO_UPTODATE; 12391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->bio->bi_idx = 0; 12401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pkt->bio->bi_rw != (1 << BIO_RW)); 12421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pkt->bio->bi_vcnt != pkt->frames); 12431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pkt->bio->bi_size != pkt->frames * CD_FRAMESIZE); 12441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pkt->bio->bi_end_io != pkt_end_io_packet_write); 12451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pkt->bio->bi_private != pkt); 12461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds drop_super(sb); 12481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 12491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 12511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds drop_super(sb); 12521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 12531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 12541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 12551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void pkt_set_state(struct packet_data *pkt, enum packet_data_state state) 12571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 12581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if PACKET_DEBUG > 1 12591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds static const char *state_name[] = { 12601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "IDLE", "WAITING", "READ_WAIT", "WRITE_WAIT", "RECOVERY", "FINISHED" 12611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }; 12621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds enum packet_data_state old_state = pkt->state; 12631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt %2d : s=%6llx %s -> %s\n", pkt->id, (unsigned long long)pkt->sector, 12641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds state_name[old_state], state_name[state]); 12651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 12661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->state = state; 12671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 12681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 12701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Scan the work queue to see if we can start a new packet. 12711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * returns non-zero if any work was done. 12721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 12731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_handle_queue(struct pktcdvd_device *pd) 12741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 12751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt, *p; 12761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio = NULL; 12771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t zone = 0; /* Suppress gcc warning */ 12781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *node, *first_node; 12791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *n; 12800a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier int wakeup; 12811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("handle_queue\n"); 12831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->scan_queue, 0); 12851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (list_empty(&pd->cdrw.pkt_free_list)) { 12871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("handle_queue: no pkt\n"); 12881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 12891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 12921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Try to find a zone we are not already working on. 12931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 12941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->lock); 12951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds first_node = pkt_rbtree_find(pd, pd->current_sector); 12961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!first_node) { 12971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds n = rb_first(&pd->bio_queue); 12981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (n) 12991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds first_node = rb_entry(n, struct pkt_rb_node, rb_node); 13001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = first_node; 13021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (node) { 13031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = node->bio; 13041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds zone = ZONE(bio->bi_sector, pd); 13051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(p, &pd->cdrw.pkt_active_list, list) { 13067baeb6a5ccab2d472679a053e64a63ac423c3a42Peter Osterlund if (p->sector == zone) { 13077baeb6a5ccab2d472679a053e64a63ac423c3a42Peter Osterlund bio = NULL; 13081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto try_next_bio; 13097baeb6a5ccab2d472679a053e64a63ac423c3a42Peter Osterlund } 13101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 13121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldstry_next_bio: 13131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = pkt_rbtree_next(node); 13141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!node) { 13151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds n = rb_first(&pd->bio_queue); 13161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (n) 13171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = rb_entry(n, struct pkt_rb_node, rb_node); 13181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (node == first_node) 13201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = NULL; 13211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->lock); 13231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio) { 13241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("handle_queue: no bio\n"); 13251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 13261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt = pkt_get_packet_data(pd, zone); 13291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->current_sector = zone + pd->settings.size; 13311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sector = zone; 1332e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund BUG_ON(pkt->frames != pd->settings.size >> 2); 13331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->write_size = 0; 13341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 13361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Scan work queue for bios in the same zone and link them 13371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * to this packet. 13381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 13391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->lock); 13401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_handle_queue: looking for zone %llx\n", (unsigned long long)zone); 13411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while ((node = pkt_rbtree_find(pd, zone)) != NULL) { 13421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = node->bio; 13431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_handle_queue: found zone=%llx\n", 13441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (unsigned long long)ZONE(bio->bi_sector, pd)); 13451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ZONE(bio->bi_sector, pd) != zone) 13461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 13471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_rbtree_erase(pd, node); 13481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 13491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_add_list_last(bio, &pkt->orig_bios, &pkt->orig_bios_tail); 13501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->write_size += bio->bi_size / CD_FRAMESIZE; 13511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 13521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13530a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier /* check write congestion marks, and if bio_queue_size is 13540a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier below, wake up any waiters */ 13550a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier wakeup = (pd->write_congestion_on > 0 13560a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier && pd->bio_queue_size <= pd->write_congestion_off); 13571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->lock); 13580a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier if (wakeup) 135983f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier clear_bdi_congested(&pd->disk->queue->backing_dev_info, WRITE); 13601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time = max(PACKET_WAIT_TIME, 1); 13621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_WAITING_STATE); 13631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->run_sm, 1); 13641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 13661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add(&pkt->list, &pd->cdrw.pkt_active_list); 13671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 13681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 13701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 13711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 13731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Assemble a bio to write one packet and queue the bio for processing 13741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * by the underlying block device. 13751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 13761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_start_write(struct pktcdvd_device *pd, struct packet_data *pkt) 13771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 13781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio; 13791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int f; 13801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int frames_write; 13817277232374680595cdbc774fd246b206f56db015Peter Osterlund struct bio_vec *bvec = pkt->w_bio->bi_io_vec; 13821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = 0; f < pkt->frames; f++) { 13847277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_page = pkt->pages[(f * CD_FRAMESIZE) / PAGE_SIZE]; 13857277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_offset = (f * CD_FRAMESIZE) % PAGE_SIZE; 13861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 13897277232374680595cdbc774fd246b206f56db015Peter Osterlund * Fill-in bvec with data from orig_bios. 13901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 13911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_write = 0; 13921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 13931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (bio = pkt->orig_bios; bio; bio = bio->bi_next) { 13941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int segment = bio->bi_idx; 13951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int src_offs = 0; 13961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int first_frame = (bio->bi_sector - pkt->sector) / (CD_FRAMESIZE >> 9); 13971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int num_frames = bio->bi_size / CD_FRAMESIZE; 13981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(first_frame < 0); 13991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(first_frame + num_frames > pkt->frames); 14001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = first_frame; f < first_frame + num_frames; f++) { 14011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio_vec *src_bvl = bio_iovec_idx(bio, segment); 14021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (src_offs >= src_bvl->bv_len) { 14041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds src_offs -= src_bvl->bv_len; 14051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds segment++; 14061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(segment >= bio->bi_vcnt); 14071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds src_bvl = bio_iovec_idx(bio, segment); 14081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (src_bvl->bv_len - src_offs >= CD_FRAMESIZE) { 14117277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_page = src_bvl->bv_page; 14127277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_offset = src_bvl->bv_offset + src_offs; 14131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 14141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_copy_bio_data(bio, segment, src_offs, 14157277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_page, bvec[f].bv_offset); 14161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds src_offs += CD_FRAMESIZE; 14181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_write++; 14191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_WRITE_WAIT_STATE); 14221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 14231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_start_write: Writing %d frames for zone %llx\n", 14251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_write, (unsigned long long)pkt->sector); 14261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(frames_write != pkt->write_size); 14271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (test_bit(PACKET_MERGE_SEGS, &pd->flags) || (pkt->write_size < pkt->frames)) { 14297277232374680595cdbc774fd246b206f56db015Peter Osterlund pkt_make_local_copy(pkt, bvec); 14301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 1; 14311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 14321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 0; 14331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Start the write request */ 14361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_init(pkt->w_bio); 14371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_max_vecs = PACKET_MAX_SIZE; 14381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_sector = pkt->sector; 14391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_bdev = pd->bdev; 14401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_end_io = pkt_end_io_packet_write; 14411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_private = pkt; 14427277232374680595cdbc774fd246b206f56db015Peter Osterlund for (f = 0; f < pkt->frames; f++) 14437277232374680595cdbc774fd246b206f56db015Peter Osterlund if (!bio_add_page(pkt->w_bio, bvec[f].bv_page, CD_FRAMESIZE, bvec[f].bv_offset)) 14447277232374680595cdbc774fd246b206f56db015Peter Osterlund BUG(); 14457822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": vcnt=%d\n", pkt->w_bio->bi_vcnt); 14461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->io_wait, 1); 14481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_rw = WRITE; 144946c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund pkt_queue_bio(pd, pkt->w_bio); 14501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 14511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_finish_packet(struct packet_data *pkt, int uptodate) 14531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 14541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio, *next; 14551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!uptodate) 14571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 0; 14581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Finish all bios corresponding to this packet */ 14601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = pkt->orig_bios; 14611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (bio) { 14621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds next = bio->bi_next; 14631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_next = NULL; 14646712ecf8f648118c3363c142196418f89a510b90NeilBrown bio_endio(bio, uptodate ? 0 : -EIO); 14651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = next; 14661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->orig_bios = pkt->orig_bios_tail = NULL; 14681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 14691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_run_state_machine(struct pktcdvd_device *pd, struct packet_data *pkt) 14711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 14721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int uptodate; 14731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("run_state_machine: pkt %d\n", pkt->id); 14751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 14771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (pkt->state) { 14781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_WAITING_STATE: 14791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pkt->write_size < pkt->frames) && (pkt->sleep_time > 0)) 14801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 14811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time = 0; 14831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_gather_data(pd, pkt); 14841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_READ_WAIT_STATE); 14851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 14861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_READ_WAIT_STATE: 14881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->io_wait) > 0) 14891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 14901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->io_errors) > 0) { 14921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_RECOVERY_STATE); 14931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 14941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_start_write(pd, pkt); 14951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 14971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_WRITE_WAIT_STATE: 14991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->io_wait) > 0) 15001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 15011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (test_bit(BIO_UPTODATE, &pkt->w_bio->bi_flags)) { 15031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_FINISHED_STATE); 15041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 15051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_RECOVERY_STATE); 15061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 15081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_RECOVERY_STATE: 15101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt_start_recovery(pkt)) { 15111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_start_write(pd, pkt); 15121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 15131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("No recovery possible\n"); 15141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_FINISHED_STATE); 15151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 15171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_FINISHED_STATE: 15191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uptodate = test_bit(BIO_UPTODATE, &pkt->w_bio->bi_flags); 15201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_finish_packet(pkt, uptodate); 15211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 15221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 15241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG(); 15251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 15261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_handle_packets(struct pktcdvd_device *pd) 15311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 15321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt, *next; 15331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_handle_packets\n"); 15351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 15371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Run state machine for active packets 15381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 15391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 15401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->run_sm) > 0) { 15411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->run_sm, 0); 15421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_run_state_machine(pd, pkt); 15431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 15471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Move no longer active packets to the free list 15481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 15491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 15501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry_safe(pkt, next, &pd->cdrw.pkt_active_list, list) { 15511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->state == PACKET_FINISHED_STATE) { 15521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_del(&pkt->list); 15531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_put_packet_data(pd, pkt); 15541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_IDLE_STATE); 15551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->scan_queue, 1); 15561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 15591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_count_states(struct pktcdvd_device *pd, int *states) 15621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 15631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 15641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 15651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1566ae7642bb05623988d8ca82b332dad1ed7bdb8cebPeter Osterlund for (i = 0; i < PACKET_NUM_STATES; i++) 15671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[i] = 0; 15681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 15701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 15711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[pkt->state]++; 15721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 15741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 15771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * kcdrwd is woken up when writes have been queued for one of our 15781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * registered devices 15791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 15801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int kcdrwd(void *foobar) 15811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 15821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = foobar; 15831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 15841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds long min_sleep_time, residue; 15851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_user_nice(current, -20); 1587831441862956fffa17b9801db37e6ea1650b0f69Rafael J. Wysocki set_freezable(); 15881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 15901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DECLARE_WAITQUEUE(wait, current); 15911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 15931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Wait until there is something to do 15941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 15951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_wait_queue(&pd->wqueue, &wait); 15961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 15971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_current_state(TASK_INTERRUPTIBLE); 15981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check if we need to run pkt_handle_queue */ 16001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->scan_queue) > 0) 16011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto work_to_do; 16021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check if we need to run the state machine for some packet */ 16041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 16051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->run_sm) > 0) 16061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto work_to_do; 16071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check if we need to process the iosched queues */ 16101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->iosched.attention) != 0) 16111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto work_to_do; 16121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Otherwise, go to sleep */ 16141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (PACKET_DEBUG > 1) { 16151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int states[PACKET_NUM_STATES]; 16161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_count_states(pd, states); 16171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("kcdrwd: i:%d ow:%d rw:%d ww:%d rec:%d fin:%d\n", 16181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[0], states[1], states[2], states[3], 16191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[4], states[5]); 16201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds min_sleep_time = MAX_SCHEDULE_TIMEOUT; 16231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 16241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sleep_time && pkt->sleep_time < min_sleep_time) 16251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds min_sleep_time = pkt->sleep_time; 16261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds generic_unplug_device(bdev_get_queue(pd->bdev)); 16291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("kcdrwd: sleeping\n"); 16311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds residue = schedule_timeout(min_sleep_time); 16321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("kcdrwd: wake up\n"); 16331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* make swsusp happy with our thread */ 16353e1d1d28d99dabe63c64f7f40f1ca1d646de1f73Christoph Lameter try_to_freeze(); 16361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 16381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt->sleep_time) 16391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 16401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time -= min_sleep_time - residue; 16411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sleep_time <= 0) { 16421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time = 0; 16431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 16441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (kthread_should_stop()) 16481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 16491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldswork_to_do: 16511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_current_state(TASK_RUNNING); 16521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remove_wait_queue(&pd->wqueue, &wait); 16531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (kthread_should_stop()) 16551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 16561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 16581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * if pkt_handle_queue returns true, we can queue 16591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * another request. 16601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 16611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (pkt_handle_queue(pd)) 16621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ; 16631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 16651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Handle packet state machine 16661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 16671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_handle_packets(pd); 16681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 16701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Handle iosched queues 16711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 16721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_iosched_process_queue(pd); 16731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 16761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 16771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_print_settings(struct pktcdvd_device *pd) 16791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16807822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": %s packets, ", pd->settings.fp ? "Fixed" : "Variable"); 16811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("%u blocks, ", pd->settings.size >> 2); 16821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("Mode-%c disc\n", pd->settings.block_mode == 8 ? '1' : '2'); 16831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 16841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_mode_sense(struct pktcdvd_device *pd, struct packet_command *cgc, int page_code, int page_control) 16861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(cgc->cmd, 0, sizeof(cgc->cmd)); 16881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[0] = GPCMD_MODE_SENSE_10; 16901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[2] = page_code | (page_control << 6); 16911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[7] = cgc->buflen >> 8; 16921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[8] = cgc->buflen & 0xff; 16931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->data_direction = CGC_DATA_READ; 16941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, cgc); 16951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 16961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_mode_select(struct pktcdvd_device *pd, struct packet_command *cgc) 16981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(cgc->cmd, 0, sizeof(cgc->cmd)); 17001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(cgc->buffer, 0, 2); 17011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[0] = GPCMD_MODE_SELECT_10; 17021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[1] = 0x10; /* PF */ 17031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[7] = cgc->buflen >> 8; 17041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[8] = cgc->buflen & 0xff; 17051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->data_direction = CGC_DATA_WRITE; 17061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, cgc); 17071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_get_disc_info(struct pktcdvd_device *pd, disc_information *di) 17101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 17111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 17121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 17131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* set up command and get the disc info */ 17151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, di, sizeof(*di), CGC_DATA_READ); 17161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_DISC_INFO; 17171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = cgc.buflen = 2; 17181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 17191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 17211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* not all drives have the same disc_info length, so requeue 17241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * packet with the length the drive tells us it can supply 17251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 17261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = be16_to_cpu(di->disc_information_length) + 17271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(di->disc_information_length); 17281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cgc.buflen > sizeof(disc_information)) 17301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = sizeof(disc_information); 17311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = cgc.buflen; 17331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 17341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_get_track_info(struct pktcdvd_device *pd, __u16 track, __u8 type, track_information *ti) 17371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 17381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 17391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 17401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, ti, 8, CGC_DATA_READ); 17421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_TRACK_RZONE_INFO; 17431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = type & 3; 17441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[4] = (track & 0xff00) >> 8; 17451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[5] = track & 0xff; 17461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = 8; 17471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 17481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 17501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = be16_to_cpu(ti->track_information_length) + 17531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(ti->track_information_length); 17541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cgc.buflen > sizeof(track_information)) 17561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = sizeof(track_information); 17571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = cgc.buflen; 17591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 17601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_get_last_written(struct pktcdvd_device *pd, long *last_written) 17631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 17641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disc_information di; 17651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds track_information ti; 17661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __u32 last_track; 17671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = -1; 17681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_disc_info(pd, &di))) 17701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last_track = (di.last_track_msb << 8) | di.last_track_lsb; 17731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_track_info(pd, last_track, 1, &ti))) 17741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* if this track is blank, try the previous. */ 17771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.blank) { 17781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last_track--; 17791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_track_info(pd, last_track, 1, &ti))) 17801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 17821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* if last recorded field is valid, return it. */ 17841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.lra_v) { 17851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *last_written = be32_to_cpu(ti.last_rec_address); 17861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 17871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* make it up instead */ 17881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *last_written = be32_to_cpu(ti.track_start) + 17891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds be32_to_cpu(ti.track_size); 17901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.free_blocks) 17911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *last_written -= (be32_to_cpu(ti.free_blocks) + 7); 17921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 17931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 17941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 17971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * write mode select package based on pd->settings 17981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 17991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_set_write_settings(struct pktcdvd_device *pd) 18001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 18011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 18021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 18031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_param_page *wp; 18041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char buffer[128]; 18051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret, size; 18061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* doesn't apply to DVD+RW or DVD-RAM */ 18081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pd->mmc3_profile == 0x1a) || (pd->mmc3_profile == 0x12)) 18091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 18101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(buffer, 0, sizeof(buffer)); 18121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buffer, sizeof(*wp), CGC_DATA_READ); 18131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 18141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_sense(pd, &cgc, GPMODE_WRITE_PARMS_PAGE, 0))) { 18151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 18161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 18171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = 2 + ((buffer[0] << 8) | (buffer[1] & 0xff)); 18201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->mode_offset = (buffer[6] << 8) | (buffer[7] & 0xff); 18211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (size > sizeof(buffer)) 18221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = sizeof(buffer); 18231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 18251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * now get it all 18261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 18271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buffer, size, CGC_DATA_READ); 18281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 18291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_sense(pd, &cgc, GPMODE_WRITE_PARMS_PAGE, 0))) { 18301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 18311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 18321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 18351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * write page is offset header + block descriptor length 18361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 18371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp = (write_param_page *) &buffer[sizeof(struct mode_page_header) + pd->mode_offset]; 18381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->fp = pd->settings.fp; 18401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->track_mode = pd->settings.track_mode; 18411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->write_type = pd->settings.write_type; 18421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->data_block_type = pd->settings.block_mode; 18431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->multi_session = 0; 18451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef PACKET_USE_LS 18471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->link_size = 7; 18481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->ls_v = 1; 18491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 18501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (wp->data_block_type == PACKET_BLOCK_MODE1) { 18521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->session_format = 0; 18531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->subhdr2 = 0x20; 18541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (wp->data_block_type == PACKET_BLOCK_MODE2) { 18551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->session_format = 0x20; 18561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->subhdr2 = 8; 18571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 0 18581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->mcn[0] = 0x80; 18591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy(&wp->mcn[1], PACKET_MCN, sizeof(wp->mcn) - 1); 18601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 18611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 18621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 18631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * paranoia 18641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 18657822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": write mode wrong %d\n", wp->data_block_type); 18661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 18671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->packet_size = cpu_to_be32(pd->settings.size >> 2); 18691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = cgc.cmd[8] = size; 18711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_select(pd, &cgc))) { 18721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 18731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 18741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_print_settings(pd); 18771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 18781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 18791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 18817c613d593370292d1685f5794c743a2323be3a09Peter Osterlund * 1 -- we can write to this track, 0 -- we can't 18821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1883ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlundstatic int pkt_writable_track(struct pktcdvd_device *pd, track_information *ti) 18841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1885ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund switch (pd->mmc3_profile) { 1886ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund case 0x1a: /* DVD+RW */ 1887ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund case 0x12: /* DVD-RAM */ 1888ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund /* The track is always writable on DVD+RW/DVD-RAM */ 1889ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund return 1; 1890ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund default: 1891ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund break; 1892ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund } 18931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1894ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (!ti->packet || !ti->fp) 1895ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund return 0; 18961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 18981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * "good" settings as per Mt Fuji. 18991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1900ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (ti->rt == 0 && ti->blank == 0) 19017c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 19021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1903ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (ti->rt == 0 && ti->blank == 1) 19047c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 19051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1906ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (ti->rt == 1 && ti->blank == 0) 19077c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 19081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19097822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": bad state %d-%d-%d\n", ti->rt, ti->blank, ti->packet); 19107c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 19111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 19121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 19147c613d593370292d1685f5794c743a2323be3a09Peter Osterlund * 1 -- we can write to this disc, 0 -- we can't 19151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 19167c613d593370292d1685f5794c743a2323be3a09Peter Osterlundstatic int pkt_writable_disc(struct pktcdvd_device *pd, disc_information *di) 19171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 19181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (pd->mmc3_profile) { 19191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x0a: /* CD-RW */ 19201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0xffff: /* MMC3 not supported */ 19211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 19221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x1a: /* DVD+RW */ 19231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x13: /* DVD-RW */ 19241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x12: /* DVD-RAM */ 19257c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 19261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 19277822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": Wrong disc profile (%x)\n", pd->mmc3_profile); 19287c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 19291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 19321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * for disc type 0xff we should probably reserve a new track. 19331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * but i'm not sure, should we leave this to user apps? probably. 19341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 19351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->disc_type == 0xff) { 19367822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Unknown disc. No track?\n"); 19377c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 19381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->disc_type != 0x20 && di->disc_type != 0) { 19417822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Wrong disc type (%x)\n", di->disc_type); 19427c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 19431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->erasable == 0) { 19467822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Disc not erasable\n"); 19477c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 19481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->border_status == PACKET_SESSION_RESERVED) { 19517822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Can't write to last track (reserved)\n"); 19527c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 19531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19557c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 19561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 19571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_probe_settings(struct pktcdvd_device *pd) 19591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 19601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 19611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[12]; 19621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disc_information di; 19631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds track_information ti; 19641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret, track; 19651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, sizeof(buf), CGC_DATA_READ); 19671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_GET_CONFIGURATION; 19681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = 8; 19691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_generic_packet(pd, &cgc); 19701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->mmc3_profile = ret ? 0xffff : buf[6] << 8 | buf[7]; 19711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&di, 0, sizeof(disc_information)); 19731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&ti, 0, sizeof(track_information)); 19741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_disc_info(pd, &di))) { 19761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("failed get_disc\n"); 19771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 19781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19807c613d593370292d1685f5794c743a2323be3a09Peter Osterlund if (!pkt_writable_disc(pd, &di)) 19819db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 19821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->type = di.erasable ? PACKET_CDRW : PACKET_CDR; 19841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds track = 1; /* (di.last_track_msb << 8) | di.last_track_lsb; */ 19861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_track_info(pd, track, 1, &ti))) { 19877822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": failed get_track\n"); 19881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 19891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1991ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (!pkt_writable_track(pd, &ti)) { 19927822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": can't write to this track\n"); 19939db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 19941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 19971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * we keep packet size in 512 byte units, makes it easier to 19981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * deal with request calculations. 19991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 20001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.size = be32_to_cpu(ti.fixed_packet_size) << 2; 20011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->settings.size == 0) { 20027822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": detected zero packet size!\n"); 2003a460ad62260def15c42130de253d6cfc32528a2fPhillip Susi return -ENXIO; 20041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2005d0272e78eee4dc53c887fd132e9035daf037d423Peter Osterlund if (pd->settings.size > PACKET_MAX_SECTORS) { 20067822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": packet size is too big\n"); 20079db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 2008d0272e78eee4dc53c887fd132e9035daf037d423Peter Osterlund } 20091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.fp = ti.fp; 20101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->offset = (be32_to_cpu(ti.track_start) << 2) & (pd->settings.size - 1); 20111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.nwa_v) { 20131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->nwa = be32_to_cpu(ti.next_writable); 20141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_NWA_VALID, &pd->flags); 20151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 20181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * in theory we could use lra on -RW media as well and just zero 20191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * blocks that haven't been written yet, but in practice that 20201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is just a no-go. we'll use that for -R, naturally. 20211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 20221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.lra_v) { 20231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->lra = be32_to_cpu(ti.last_rec_address); 20241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_LRA_VALID, &pd->flags); 20251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 20261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->lra = 0xffffffff; 20271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_LRA_VALID, &pd->flags); 20281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 20311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * fine for now 20321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 20331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.link_loss = 7; 20341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.write_type = 0; /* packet */ 20351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.track_mode = ti.track_mode; 20361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 20381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * mode1 or mode2 disc 20391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 20401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (ti.data_mode) { 20411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_MODE1: 20421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.block_mode = PACKET_BLOCK_MODE1; 20431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 20441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_MODE2: 20451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.block_mode = PACKET_BLOCK_MODE2; 20461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 20471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 20487822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": unknown data mode\n"); 20499db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 20501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 20521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 20531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 20551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * enable/disable write caching on drive 20561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 20571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_write_caching(struct pktcdvd_device *pd, int set) 20581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 20591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 20601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 20611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[64]; 20621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 20631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(buf, 0, sizeof(buf)); 20651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, sizeof(buf), CGC_DATA_READ); 20661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 20671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = pd->mode_offset + 12; 20681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 20701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * caching mode page might not be there, so quiet this command 20711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 20721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 20731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_sense(pd, &cgc, GPMODE_WCACHING_PAGE, 0))) 20751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 20761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf[pd->mode_offset + 10] |= (!!set << 2); 20781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = cgc.cmd[8] = 2 + ((buf[0] << 8) | (buf[1] & 0xff)); 20801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_mode_select(pd, &cgc); 20811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 20827822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": write caching control failed\n"); 20831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 20841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (!ret && set) 20857822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": enabled write caching on %s\n", pd->name); 20861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 20871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 20881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_lock_door(struct pktcdvd_device *pd, int lockflag) 20901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 20911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 20921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 20941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL; 20951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[4] = lockflag ? 1 : 0; 20961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 20971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 20981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Returns drive maximum write speed 21011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 21021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_get_max_speed(struct pktcdvd_device *pd, unsigned *write_speed) 21031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 21041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 21051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 21061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[256+18]; 21071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char *cap_buf; 21081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret, offset; 21091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(buf, 0, sizeof(buf)); 21111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cap_buf = &buf[sizeof(struct mode_page_header) + pd->mode_offset]; 21121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, sizeof(buf), CGC_DATA_UNKNOWN); 21131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 21141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_mode_sense(pd, &cgc, GPMODE_CAPABILITIES_PAGE, 0); 21161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 21171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = pd->mode_offset + cap_buf[1] + 2 + 21181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(struct mode_page_header); 21191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_mode_sense(pd, &cgc, GPMODE_CAPABILITIES_PAGE, 0); 21201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 21211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 21221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 21231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = 20; /* Obsoleted field, used by older drives */ 21271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cap_buf[1] >= 28) 21281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = 28; /* Current write speed selected */ 21291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cap_buf[1] >= 30) { 21301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* If the drive reports at least one "Logical Unit Write 21311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Speed Performance Descriptor Block", use the information 21321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * in the first block. (contains the highest speed) 21331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 21341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int num_spdb = (cap_buf[30] << 8) + cap_buf[31]; 21351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (num_spdb > 0) 21361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = 34; 21371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *write_speed = (cap_buf[offset] << 8) | cap_buf[offset + 1]; 21401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 21411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 21421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* These tables from cdrecord - I don't have orange book */ 21441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* standard speed CD-RW (1-4x) */ 21451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic char clv_to_speed[16] = { 21461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */ 21471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0, 2, 4, 6, 8, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 21481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 21491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* high speed CD-RW (-10x) */ 21501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic char hs_clv_to_speed[16] = { 21511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */ 21521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0, 2, 4, 6, 10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 21531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 21541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* ultra high speed CD-RW */ 21551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic char us_clv_to_speed[16] = { 21561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */ 21571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0, 2, 4, 8, 0, 0,16, 0,24,32,40,48, 0, 0, 0, 0 21581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 21591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * reads the maximum media speed from ATIP 21621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 21631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_media_speed(struct pktcdvd_device *pd, unsigned *speed) 21641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 21651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 21661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 21671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[64]; 21681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int size, st, sp; 21691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 21701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, 2, CGC_DATA_READ); 21721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 21731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_TOC_PMA_ATIP; 21741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 2; 21751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[2] = 4; /* READ ATIP */ 21761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = 2; 21771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_generic_packet(pd, &cgc); 21781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 21791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 21801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 21811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = ((unsigned int) buf[0]<<8) + buf[1] + 2; 21831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (size > sizeof(buf)) 21841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = sizeof(buf); 21851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, size, CGC_DATA_READ); 21871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 21881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_TOC_PMA_ATIP; 21891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 2; 21901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[2] = 4; 21911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = size; 21921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_generic_packet(pd, &cgc); 21931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 21941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 21951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 21961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!buf[6] & 0x40) { 21997822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Disc type is not CD-RW\n"); 22001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 22011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!buf[6] & 0x4) { 22037822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": A1 values on media are not valid, maybe not CDRW?\n"); 22041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 22051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds st = (buf[6] >> 3) & 0x7; /* disc sub-type */ 22081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sp = buf[16] & 0xf; /* max speed from ATIP A1 field */ 22101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Info from cdrecord */ 22121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (st) { 22131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0: /* standard speed */ 22141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *speed = clv_to_speed[sp]; 22151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 22161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 1: /* high speed */ 22171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *speed = hs_clv_to_speed[sp]; 22181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 22191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 2: /* ultra high speed */ 22201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *speed = us_clv_to_speed[sp]; 22211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 22221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 22237822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Unknown disc sub-type %d\n",st); 22241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 22251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (*speed) { 22277822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Max. media speed: %d\n",*speed); 22281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 22291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 22307822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Unknown speed %d for sub-type %d\n",sp,st); 22311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 22321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 22341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_perform_opc(struct pktcdvd_device *pd) 22361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 22371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 22381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 22391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 22401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22417822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": Performing OPC\n"); 22421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 22441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 22451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.timeout = 60*HZ; 22461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_SEND_OPC; 22471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 1; 22481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 22491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 22501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 22511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 22521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_open_write(struct pktcdvd_device *pd) 22541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 22551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 22561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int write_speed, media_write_speed, read_speed; 22571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_probe_settings(pd))) { 22597822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": %s failed probe\n", pd->name); 22609db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return ret; 22611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_set_write_settings(pd))) { 22647822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": %s failed saving write settings\n", pd->name); 22651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 22661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_write_caching(pd, USE_WCACHING); 22691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_max_speed(pd, &write_speed))) 22711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_speed = 16 * 177; 22721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (pd->mmc3_profile) { 22731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x13: /* DVD-RW */ 22741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x1a: /* DVD+RW */ 22751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x12: /* DVD-RAM */ 22767822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": write speed %ukB/s\n", write_speed); 22771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 22781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 22791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_media_speed(pd, &media_write_speed))) 22801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds media_write_speed = 16; 22811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_speed = min(write_speed, media_write_speed * 177); 22827822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": write speed %ux\n", write_speed / 176); 22831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 22841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_speed = write_speed; 22861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_set_speed(pd, write_speed, read_speed))) { 22887822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": %s couldn't set write speed\n", pd->name); 22891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 22901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->write_speed = write_speed; 22921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->read_speed = read_speed; 22931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_perform_opc(pd))) { 22957822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": %s Optimum Power Calibration failed\n", pd->name); 22961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 22991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 23001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 23021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * called at open time. 23031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 23041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_open_dev(struct pktcdvd_device *pd, int write) 23051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 23061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 23071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds long lba; 2308165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboe struct request_queue *q; 23091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 23111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * We need to re-open the cdrom device without O_NONBLOCK to be able 23121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * to read/write from/to it. It is already opened in O_NONBLOCK mode 23131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * so bdget() can't fail. 23141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 23151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdget(pd->bdev->bd_dev); 23161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = blkdev_get(pd->bdev, FMODE_READ, O_RDONLY))) 23171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 23181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23198382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund if ((ret = bd_claim(pd->bdev, pd))) 23208382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund goto out_putdev; 23218382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund 23221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_last_written(pd, &lba))) { 23237822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": pkt_get_last_written failed\n"); 23248382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund goto out_unclaim; 23251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_capacity(pd->disk, lba << 2); 23281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_capacity(pd->bdev->bd_disk, lba << 2); 23291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bd_set_size(pd->bdev, (loff_t)lba << 11); 23301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds q = bdev_get_queue(pd->bdev); 23321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (write) { 23331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_open_write(pd))) 23348382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund goto out_unclaim; 23351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 23361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Some CDRW drives can not handle writes larger than one packet, 23371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * even if the size is a multiple of the packet size. 23381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 23391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(q->queue_lock); 23401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_max_sectors(q, pd->settings.size); 23411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(q->queue_lock); 23421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_WRITABLE, &pd->flags); 23431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 23441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, MAX_SPEED, MAX_SPEED); 23451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds clear_bit(PACKET_WRITABLE, &pd->flags); 23461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_set_segment_merging(pd, q))) 23498382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund goto out_unclaim; 23501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2351e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund if (write) { 2352e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund if (!pkt_grow_pktlist(pd, CONFIG_CDROM_PKTCDVD_BUFFERS)) { 23537822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": not enough memory for buffers\n"); 2354e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund ret = -ENOMEM; 2355e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund goto out_unclaim; 2356e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund } 23577822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": %lukB available on disc\n", lba << 1); 2358e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund } 23591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 23611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23628382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlundout_unclaim: 23638382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund bd_release(pd->bdev); 23641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_putdev: 23651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blkdev_put(pd->bdev); 23661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 23671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 23681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 23691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 23711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * called when the device is closed. makes sure that the device flushes 23721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the internal cache before we close. 23731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 23741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_release_dev(struct pktcdvd_device *pd, int flush) 23751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 23761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (flush && pkt_flush_cache(pd)) 23777822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": %s not flushing cache\n", pd->name); 23781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_lock_door(pd, 0); 23801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, MAX_SPEED, MAX_SPEED); 23828382bf2e72d16d0532e351299121ccd3bca0fdd8Peter Osterlund bd_release(pd->bdev); 23831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blkdev_put(pd->bdev); 2384e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund 2385e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund pkt_shrink_pktlist(pd); 23861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 23871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct pktcdvd_device *pkt_find_dev_from_minor(int dev_minor) 23891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 23901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev_minor >= MAX_WRITERS) 23911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 23921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_devs[dev_minor]; 23931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 23941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_open(struct inode *inode, struct file *file) 23961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 23971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = NULL; 23981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 23991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24007822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": entering open\n"); 24011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24021657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_lock(&ctl_mutex); 24031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd = pkt_find_dev_from_minor(iminor(inode)); 24041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd) { 24051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENODEV; 24061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 24071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 24081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->refcnt < 0); 24091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->refcnt++; 241146f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund if (pd->refcnt > 1) { 241246f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund if ((file->f_mode & FMODE_WRITE) && 241346f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund !test_bit(PACKET_WRITABLE, &pd->flags)) { 241446f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund ret = -EBUSY; 241546f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund goto out_dec; 241646f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund } 241746f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund } else { 241801fd9fda2ce462b44bafdac2fe6aacacf23531f2Peter Osterlund ret = pkt_open_dev(pd, file->f_mode & FMODE_WRITE); 241901fd9fda2ce462b44bafdac2fe6aacacf23531f2Peter Osterlund if (ret) 24201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_dec; 24211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 24221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * needed here as well, since ext2 (among others) may change 24231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the blocksize at mount time 24241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 24251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_blocksize(inode->i_bdev, CD_FRAMESIZE); 24261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 24271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24281657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_unlock(&ctl_mutex); 24291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 24301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_dec: 24321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->refcnt--; 24331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 24347822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": failed open (%d)\n", ret); 24351657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_unlock(&ctl_mutex); 24361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 24371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 24381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_close(struct inode *inode, struct file *file) 24401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 24411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = inode->i_bdev->bd_disk->private_data; 24421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = 0; 24431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24441657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_lock(&ctl_mutex); 24451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->refcnt--; 24461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->refcnt < 0); 24471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->refcnt == 0) { 24481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int flush = test_bit(PACKET_WRITABLE, &pd->flags); 24491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_release_dev(pd, flush); 24501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 24511657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_unlock(&ctl_mutex); 24521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 24531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 24541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24566712ecf8f648118c3363c142196418f89a510b90NeilBrownstatic void pkt_end_io_read_cloned(struct bio *bio, int err) 24571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 24581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_stacked_data *psd = bio->bi_private; 24591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = psd->pd; 24601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(bio); 24626712ecf8f648118c3363c142196418f89a510b90NeilBrown bio_endio(psd->bio, err); 24631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_free(psd, psd_pool); 24641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bio_finished(pd); 24651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 24661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2467165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboestatic int pkt_make_request(struct request_queue *q, struct bio *bio) 24681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 24691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd; 24701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char b[BDEVNAME_SIZE]; 24711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t zone; 24721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 24731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int was_empty, blocked_bio; 24741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *node; 24751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd = q->queuedata; 24771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd) { 24787822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": %s incorrect request queue\n", bdevname(bio->bi_bdev, b)); 24791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto end_io; 24801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 24811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 24831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Clone READ bios so we can have our own bi_end_io callback. 24841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 24851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio_data_dir(bio) == READ) { 24861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *cloned_bio = bio_clone(bio, GFP_NOIO); 24871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_stacked_data *psd = mempool_alloc(psd_pool, GFP_NOIO); 24881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds psd->pd = pd; 24901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds psd->bio = bio; 24911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cloned_bio->bi_bdev = pd->bdev; 24921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cloned_bio->bi_private = psd; 24931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cloned_bio->bi_end_io = pkt_end_io_read_cloned; 24941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->stats.secs_r += bio->bi_size >> 9; 249546c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund pkt_queue_bio(pd, cloned_bio); 24961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 24971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 24981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!test_bit(PACKET_WRITABLE, &pd->flags)) { 25007822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": WRITE for ro device %s (%llu)\n", 25011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->name, (unsigned long long)bio->bi_sector); 25021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto end_io; 25031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio->bi_size || (bio->bi_size % CD_FRAMESIZE)) { 25067822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": wrong bio size\n"); 25071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto end_io; 25081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_bounce(q, &bio); 25111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds zone = ZONE(bio->bi_sector, pd); 25131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_make_request: start = %6llx stop = %6llx\n", 25141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (unsigned long long)bio->bi_sector, 25151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (unsigned long long)(bio->bi_sector + bio_sectors(bio))); 25161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check if we have to split the bio */ 25181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 25191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio_pair *bp; 25201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t last_zone; 25211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int first_sectors; 25221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last_zone = ZONE(bio->bi_sector + bio_sectors(bio) - 1, pd); 25241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (last_zone != zone) { 25251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(last_zone != zone + pd->settings.size); 25261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds first_sectors = last_zone - bio->bi_sector; 25271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bp = bio_split(bio, bio_split_pool, first_sectors); 25281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!bp); 25291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_make_request(q, &bp->bio1); 25301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_make_request(q, &bp->bio2); 25311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_pair_release(bp); 25321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 25331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 25371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * If we find a matching packet in state WAITING or READ_WAIT, we can 25381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * just append this bio to that packet. 25391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 25401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 25411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blocked_bio = 0; 25421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 25431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sector == zone) { 25441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 25451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pkt->state == PACKET_WAITING_STATE) || 25461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (pkt->state == PACKET_READ_WAIT_STATE)) { 25471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_add_list_last(bio, &pkt->orig_bios, 25481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds &pkt->orig_bios_tail); 25491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->write_size += bio->bi_size / CD_FRAMESIZE; 25501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pkt->write_size >= pkt->frames) && 25511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (pkt->state == PACKET_WAITING_STATE)) { 25521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 25531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 25541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 25561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 25571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 25581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 25591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blocked_bio = 1; 25601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 25621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 25651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25660a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier /* 25670a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier * Test if there is enough room left in the bio work queue 25680a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier * (queue size >= congestion on mark). 25690a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier * If not, wait till the work queue size is below the congestion off mark. 25700a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier */ 25710a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_lock(&pd->lock); 25720a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier if (pd->write_congestion_on > 0 25730a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier && pd->bio_queue_size >= pd->write_congestion_on) { 257483f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier set_bdi_congested(&q->backing_dev_info, WRITE); 25750a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier do { 25760a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_unlock(&pd->lock); 25770a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier congestion_wait(WRITE, HZ); 25780a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_lock(&pd->lock); 25790a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier } while(pd->bio_queue_size > pd->write_congestion_off); 25800a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier } 25810a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_unlock(&pd->lock); 25820a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier 25831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 25841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * No matching packet found. Store the bio in the work queue. 25851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 25861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = mempool_alloc(pd->rb_pool, GFP_NOIO); 25871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node->bio = bio; 25881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->lock); 25891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->bio_queue_size < 0); 25901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds was_empty = (pd->bio_queue_size == 0); 25911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_rbtree_insert(pd, node); 25921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->lock); 25931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 25951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Wake up the worker thread. 25961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 25971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->scan_queue, 1); 25981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (was_empty) { 25991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This wake_up is required for correct operation */ 26001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 26011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (!list_empty(&pd->cdrw.pkt_free_list) && !blocked_bio) { 26021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 26031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This wake up is not required for correct operation, 26041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * but improves performance in some cases. 26051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 26061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 26071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 26081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 26091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsend_io: 26106712ecf8f648118c3363c142196418f89a510b90NeilBrown bio_io_error(bio); 26111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 26121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 26131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2616165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboestatic int pkt_merge_bvec(struct request_queue *q, struct bio *bio, struct bio_vec *bvec) 26171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 26181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = q->queuedata; 26191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t zone = ZONE(bio->bi_sector, pd); 26201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int used = ((bio->bi_sector - zone) << 9) + bio->bi_size; 26211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int remaining = (pd->settings.size << 9) - used; 26221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int remaining2; 26231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 26251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * A bio <= PAGE_SIZE must be allowed. If it crosses a packet 26261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * boundary, pkt_make_request() will split the bio. 26271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 26281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remaining2 = PAGE_SIZE - bio->bi_size; 26291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remaining = max(remaining, remaining2); 26301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(remaining < 0); 26321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return remaining; 26331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 26341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_init_queue(struct pktcdvd_device *pd) 26361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2637165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboe struct request_queue *q = pd->disk->queue; 26381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_make_request(q, pkt_make_request); 26401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_hardsect_size(q, CD_FRAMESIZE); 26411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_max_sectors(q, PACKET_MAX_SECTORS); 26421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_merge_bvec(q, pkt_merge_bvec); 26431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds q->queuedata = pd; 26441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 26451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_seq_show(struct seq_file *m, void *p) 26471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 26481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = m->private; 26491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char *msg; 26501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char bdev_buf[BDEVNAME_SIZE]; 26511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int states[PACKET_NUM_STATES]; 26521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "Writer %s mapped to %s:\n", pd->name, 26541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdevname(pd->bdev, bdev_buf)); 26551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nSettings:\n"); 26571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpacket size:\t\t%dkB\n", pd->settings.size / 2); 26581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->settings.write_type == 0) 26601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Packet"; 26611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 26621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Unknown"; 26631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\twrite type:\t\t%s\n", msg); 26641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpacket type:\t\t%s\n", pd->settings.fp ? "Fixed" : "Variable"); 26661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tlink loss:\t\t%d\n", pd->settings.link_loss); 26671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\ttrack mode:\t\t%d\n", pd->settings.track_mode); 26691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->settings.block_mode == PACKET_BLOCK_MODE1) 26711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Mode 1"; 26721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (pd->settings.block_mode == PACKET_BLOCK_MODE2) 26731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Mode 2"; 26741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 26751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Unknown"; 26761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tblock mode:\t\t%s\n", msg); 26771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nStatistics:\n"); 26791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpackets started:\t%lu\n", pd->stats.pkt_started); 26801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpackets ended:\t\t%lu\n", pd->stats.pkt_ended); 26811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\twritten:\t\t%lukB\n", pd->stats.secs_w >> 1); 26821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tread gather:\t\t%lukB\n", pd->stats.secs_rg >> 1); 26831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tread:\t\t\t%lukB\n", pd->stats.secs_r >> 1); 26841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nMisc:\n"); 26861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\treference count:\t%d\n", pd->refcnt); 26871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tflags:\t\t\t0x%lx\n", pd->flags); 26881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tread speed:\t\t%ukB/s\n", pd->read_speed); 26891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\twrite speed:\t\t%ukB/s\n", pd->write_speed); 26901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tstart offset:\t\t%lu\n", pd->offset); 26911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tmode page offset:\t%u\n", pd->mode_offset); 26921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nQueue state:\n"); 26941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tbios queued:\t\t%d\n", pd->bio_queue_size); 26951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tbios pending:\t\t%d\n", atomic_read(&pd->cdrw.pending_bios)); 26961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tcurrent sector:\t\t0x%llx\n", (unsigned long long)pd->current_sector); 26971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_count_states(pd, states); 26991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tstate:\t\t\ti:%d ow:%d rw:%d ww:%d rec:%d fin:%d\n", 27001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[0], states[1], states[2], states[3], states[4], states[5]); 27011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27020a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier seq_printf(m, "\twrite congestion marks:\toff=%d on=%d\n", 27030a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_off, 27040a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_on); 27051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 27061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 27071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_seq_open(struct inode *inode, struct file *file) 27091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 27101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return single_open(file, pkt_seq_show, PDE(inode)->data); 27111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 27121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27132b8693c0617e972fc0b2fd1ebf8de97e15b656c3Arjan van de Venstatic const struct file_operations pkt_proc_fops = { 27141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .open = pkt_seq_open, 27151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .read = seq_read, 27161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .llseek = seq_lseek, 27171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .release = single_release 27181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 27191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_new_dev(struct pktcdvd_device *pd, dev_t dev) 27211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 27221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 27231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = 0; 27241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char b[BDEVNAME_SIZE]; 27251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct proc_dir_entry *proc; 27261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct block_device *bdev; 27271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->pkt_dev == dev) { 27297822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Recursive setup not allowed\n"); 27301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 27311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 27321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < MAX_WRITERS; i++) { 27331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd2 = pkt_devs[i]; 27341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd2) 27351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 27361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd2->bdev->bd_dev == dev) { 27377822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": %s already setup\n", bdevname(pd2->bdev, b)); 27381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 27391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 27401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd2->pkt_dev == dev) { 27417822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Can't chain pktcdvd devices\n"); 27421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 27431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 27441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 27451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdev = bdget(dev); 27471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bdev) 27481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 27491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = blkdev_get(bdev, FMODE_READ, O_RDONLY | O_NONBLOCK); 27501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) 27511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 27521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This is safe, since we have a reference from open(). */ 27541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __module_get(THIS_MODULE); 27551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bdev = bdev; 27571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_blocksize(bdev, CD_FRAMESIZE); 27581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_init_queue(pd); 27601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->cdrw.pending_bios, 0); 27621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->cdrw.thread = kthread_run(kcdrwd, pd, "%s", pd->name); 27631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (IS_ERR(pd->cdrw.thread)) { 27647822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": can't start kernel thread\n"); 27651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENOMEM; 2766e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund goto out_mem; 27671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 27681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds proc = create_proc_entry(pd->name, 0, pkt_proc); 27701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (proc) { 27711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds proc->data = pd; 27721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds proc->proc_fops = &pkt_proc_fops; 27731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 27747822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": writer %s mapped to %s\n", pd->name, bdevname(bdev, b)); 27751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 27761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_mem: 27781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blkdev_put(bdev); 27791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This is safe: open() is still holding a reference. */ 27801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds module_put(THIS_MODULE); 27811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 27821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 27831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg) 27851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 27861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = inode->i_bdev->bd_disk->private_data; 27871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_ioctl: cmd %x, dev %d:%d\n", cmd, imajor(inode), iminor(inode)); 27891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 27911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 27921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * forward selected CDROM ioctls to CD-ROM, for UDF 27931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 27941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROMMULTISESSION: 27951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROMREADTOCENTRY: 27961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROM_LAST_WRITTEN: 27971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROM_SEND_PACKET: 27981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case SCSI_IOCTL_SEND_COMMAND: 2799118326e940bdecef6c459d42ccf05256ba86daa7Peter Osterlund return blkdev_ioctl(pd->bdev->bd_inode, file, cmd, arg); 28001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROMEJECT: 28021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 28031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * The door gets locked when the device is opened, so we 28041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * have to unlock it or else the eject command fails. 28051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2806948423e5ccc33bc257384ad4b339214c577bc926Peter Osterlund if (pd->refcnt == 1) 2807948423e5ccc33bc257384ad4b339214c577bc926Peter Osterlund pkt_lock_door(pd, 0); 2808118326e940bdecef6c459d42ccf05256ba86daa7Peter Osterlund return blkdev_ioctl(pd->bdev->bd_inode, file, cmd, arg); 28091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 28117822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": Unknown ioctl for %s (%x)\n", pd->name, cmd); 28121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOTTY; 28131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 28141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 28161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 28171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_media_changed(struct gendisk *disk) 28191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 28201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = disk->private_data; 28211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct gendisk *attached_disk; 28221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd) 28241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 28251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd->bdev) 28261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 28271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds attached_disk = pd->bdev->bd_disk; 28281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!attached_disk) 28291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 28301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return attached_disk->fops->media_changed(attached_disk); 28311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 28321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct block_device_operations pktcdvd_ops = { 28341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 28351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .open = pkt_open, 28361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .release = pkt_close, 28371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ioctl = pkt_ioctl, 28381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .media_changed = pkt_media_changed, 28391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 28401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 28421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Set up mapping from pktcdvd device to CD-ROM device. 28431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2844adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierstatic int pkt_setup_dev(dev_t dev, dev_t* pkt_dev) 28451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 28461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int idx; 28471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = -ENOMEM; 28481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd; 28491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct gendisk *disk; 2850adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2851adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 28521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (idx = 0; idx < MAX_WRITERS; idx++) 28541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt_devs[idx]) 28551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 28561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (idx == MAX_WRITERS) { 28577822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": max %d writers supported\n", MAX_WRITERS); 2858adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = -EBUSY; 2859adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out_mutex; 28601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 28611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28621107d2e0352769b9bde6a4877c295b9309cdb877Peter Osterlund pd = kzalloc(sizeof(struct pktcdvd_device), GFP_KERNEL); 28631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd) 2864adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out_mutex; 28651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28660eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson pd->rb_pool = mempool_create_kmalloc_pool(PKT_RB_POOL_SIZE, 28670eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson sizeof(struct pkt_rb_node)); 28681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd->rb_pool) 28691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_mem; 28701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2871e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund INIT_LIST_HEAD(&pd->cdrw.pkt_free_list); 2872e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund INIT_LIST_HEAD(&pd->cdrw.pkt_active_list); 2873e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund spin_lock_init(&pd->cdrw.active_list_lock); 2874e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund 28751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_init(&pd->lock); 28761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_init(&pd->iosched.lock); 28777822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier sprintf(pd->name, DRIVER_NAME"%d", idx); 28781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_waitqueue_head(&pd->wqueue); 28791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bio_queue = RB_ROOT; 28801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28810a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_on = write_congestion_on; 28820a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_off = write_congestion_off; 28830a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier 2884adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier disk = alloc_disk(1); 2885adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier if (!disk) 2886adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out_mem; 2887adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier pd->disk = disk; 2888add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier disk->major = pktdev_major; 28891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->first_minor = idx; 28901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->fops = &pktcdvd_ops; 28911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->flags = GENHD_FL_REMOVABLE; 2892adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier strcpy(disk->disk_name, pd->name); 28931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->private_data = pd; 28941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->queue = blk_alloc_queue(GFP_KERNEL); 28951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!disk->queue) 28961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_mem2; 28971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->pkt_dev = MKDEV(disk->major, disk->first_minor); 28991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_new_dev(pd, dev); 29001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) 29011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_new_dev; 29021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_disk(disk); 2904adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 290532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_dev_new(pd); 290632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_dev_new(pd); 290732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 29081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_devs[idx] = pd; 2909adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier if (pkt_dev) 2910adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier *pkt_dev = pd->pkt_dev; 2911adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2912adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 29131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 29141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_new_dev: 29161312f40e11c57edb5c3250f1b782cef8e3efea82Al Viro blk_cleanup_queue(disk->queue); 29171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_mem2: 29181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds put_disk(disk); 29191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_mem: 29201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->rb_pool) 29211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(pd->rb_pool); 29221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pd); 2923adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierout_mutex: 2924adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 2925adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier printk(DRIVER_NAME": setup of pktcdvd device failed\n"); 29261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 29271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 29281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 29301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Tear down mapping from pktcdvd device to CD-ROM device. 29311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2932adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierstatic int pkt_remove_dev(dev_t pkt_dev) 29331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 29341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd; 29351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int idx; 2936adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier int ret = 0; 2937adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2938adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 29391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (idx = 0; idx < MAX_WRITERS; idx++) { 29411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd = pkt_devs[idx]; 29421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd && (pd->pkt_dev == pkt_dev)) 29431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 29441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 29451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (idx == MAX_WRITERS) { 29467822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": dev not setup\n"); 2947adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = -ENXIO; 2948adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out; 29491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 29501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2951adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier if (pd->refcnt > 0) { 2952adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = -EBUSY; 2953adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out; 2954adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier } 29551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!IS_ERR(pd->cdrw.thread)) 29561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kthread_stop(pd->cdrw.thread); 29571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 295832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_devs[idx] = NULL; 295932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 296032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_dev_remove(pd); 296132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_dev_remove(pd); 296232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 29631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blkdev_put(pd->bdev); 29641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remove_proc_entry(pd->name, pkt_proc); 29667822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": writer %s unmapped\n", pd->name); 29671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds del_gendisk(pd->disk); 29691312f40e11c57edb5c3250f1b782cef8e3efea82Al Viro blk_cleanup_queue(pd->disk->queue); 29701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds put_disk(pd->disk); 29711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(pd->rb_pool); 29731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pd); 29741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This is safe: open() is still holding a reference. */ 29761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds module_put(THIS_MODULE); 2977adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2978adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierout: 2979adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 2980adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier return ret; 29811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 29821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_get_status(struct pkt_ctrl_command *ctrl_cmd) 29841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2985adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier struct pktcdvd_device *pd; 2986adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2987adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 2988adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2989adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier pd = pkt_find_dev_from_minor(ctrl_cmd->dev_index); 29901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd) { 29911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->dev = new_encode_dev(pd->bdev->bd_dev); 29921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->pkt_dev = new_encode_dev(pd->pkt_dev); 29931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 29941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->dev = 0; 29951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->pkt_dev = 0; 29961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 29971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->num_devices = MAX_WRITERS; 2998adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2999adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 30001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 30011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_ctl_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg) 30031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 30041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void __user *argp = (void __user *)arg; 30051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_ctrl_command ctrl_cmd; 30061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = 0; 3007adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier dev_t pkt_dev = 0; 30081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cmd != PACKET_CTRL_CMD) 30101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOTTY; 30111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_from_user(&ctrl_cmd, argp, sizeof(struct pkt_ctrl_command))) 30131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 30141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (ctrl_cmd.command) { 30161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PKT_CTRL_CMD_SETUP: 30171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!capable(CAP_SYS_ADMIN)) 30181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EPERM; 3019adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = pkt_setup_dev(new_decode_dev(ctrl_cmd.dev), &pkt_dev); 3020adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ctrl_cmd.pkt_dev = new_encode_dev(pkt_dev); 30211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 30221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PKT_CTRL_CMD_TEARDOWN: 30231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!capable(CAP_SYS_ADMIN)) 30241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EPERM; 3025adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = pkt_remove_dev(new_decode_dev(ctrl_cmd.pkt_dev)); 30261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 30271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PKT_CTRL_CMD_STATUS: 30281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_get_status(&ctrl_cmd); 30291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 30301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 30311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOTTY; 30321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 30331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_to_user(argp, &ctrl_cmd, sizeof(struct pkt_ctrl_command))) 30351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 30361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 30371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 30381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30402b8693c0617e972fc0b2fd1ebf8de97e15b656c3Arjan van de Venstatic const struct file_operations pkt_ctl_fops = { 30411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ioctl = pkt_ctl_ioctl, 30421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 30431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 30441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct miscdevice pkt_misc = { 30461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .minor = MISC_DYNAMIC_MINOR, 30477822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier .name = DRIVER_NAME, 30481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .fops = &pkt_ctl_fops 30491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 30501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init pkt_init(void) 30521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 30531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 30541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 305532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier mutex_init(&ctl_mutex); 305632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 30570eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson psd_pool = mempool_create_kmalloc_pool(PSD_POOL_SIZE, 30580eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson sizeof(struct packet_stacked_data)); 30591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!psd_pool) 30601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 30611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3062add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier ret = register_blkdev(pktdev_major, DRIVER_NAME); 30631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret < 0) { 30647822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Unable to register block device\n"); 30651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out2; 30661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3067add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier if (!pktdev_major) 3068add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier pktdev_major = ret; 30691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 307032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier ret = pkt_sysfs_init(); 307132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (ret) 307232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier goto out; 307332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 307432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_init(); 307532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 30761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = misc_register(&pkt_misc); 30771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 30787822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Unable to register misc device\n"); 307932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier goto out_misc; 30801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 30811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30827822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier pkt_proc = proc_mkdir(DRIVER_NAME, proc_root_driver); 30831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 30851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 308632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierout_misc: 308732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_cleanup(); 308832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_cleanup(); 30891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 3090add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier unregister_blkdev(pktdev_major, DRIVER_NAME); 30911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout2: 30921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(psd_pool); 30931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 30941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 30951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit pkt_exit(void) 30971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 30987822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier remove_proc_entry(DRIVER_NAME, proc_root_driver); 30991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds misc_deregister(&pkt_misc); 310032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 310132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_cleanup(); 310232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_cleanup(); 310332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 3104add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier unregister_blkdev(pktdev_major, DRIVER_NAME); 31051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(psd_pool); 31061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 31071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 31081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DESCRIPTION("Packet writing layer for CD/DVD drives"); 31091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Jens Axboe <axboe@suse.de>"); 31101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 31111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 31121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(pkt_init); 31131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(pkt_exit); 3114