pktcdvd.c revision f73a1c7d117d07a96d89475066188a2b79e53c48
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> 51f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann#include <linux/compat.h> 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kthread.h> 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/errno.h> 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/spinlock.h> 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/file.h> 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/proc_fs.h> 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/seq_file.h> 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/miscdevice.h> 597dfb71030f7636a0d65200158113c37764552f93Nigel Cunningham#include <linux/freezer.h> 601657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen#include <linux/mutex.h> 615a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <scsi/scsi_cmnd.h> 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <scsi/scsi_ioctl.h> 64cef289633a9321cd99dd5f6cc935657dc487e9f0Peter Osterlund#include <scsi/scsi.h> 6532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier#include <linux/debugfs.h> 6632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier#include <linux/device.h> 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/uaccess.h> 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 707822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier#define DRIVER_NAME "pktcdvd" 717822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if PACKET_DEBUG 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DPRINTK(fmt, args...) printk(KERN_NOTICE fmt, ##args) 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DPRINTK(fmt, args...) 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if PACKET_DEBUG > 1 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define VPRINTK(fmt, args...) printk(KERN_NOTICE fmt, ##args) 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define VPRINTK(fmt, args...) 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MAX_SPEED 0xffff 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ZONE(sector, pd) (((sector) + (pd)->offset) & ~((pd)->settings.size - 1)) 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 882a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmannstatic DEFINE_MUTEX(pktcdvd_mutex); 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct pktcdvd_device *pkt_devs[MAX_WRITERS]; 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct proc_dir_entry *pkt_proc; 91add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maierstatic int pktdev_major; 920a0fc9601dd1024ec7171993bf075a789246e1edThomas Maierstatic int write_congestion_on = PKT_WRITE_CONGESTION_ON; 930a0fc9601dd1024ec7171993bf075a789246e1edThomas Maierstatic int write_congestion_off = PKT_WRITE_CONGESTION_OFF; 941657f824e880a9bd239a3436b820d1a2986f763dJes Sorensenstatic struct mutex ctl_mutex; /* Serialize open/close/setup/teardown */ 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic mempool_t *psd_pool; 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct class *class_pktcdvd = NULL; /* /sys/class/pktcdvd */ 98ea5ffff57dce2f4c85ab056f4b0a202f71db2bdfGeunSik Limstatic struct dentry *pkt_debugfs_root = NULL; /* /sys/kernel/debug/pktcdvd */ 9932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 10032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* forward declaration */ 10132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_setup_dev(dev_t dev, dev_t* pkt_dev); 10232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_remove_dev(dev_t pkt_dev); 10332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_seq_show(struct seq_file *m, void *p); 10432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 10532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 10632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 10732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* 10832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * create and register a pktcdvd kernel object. 10932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier */ 11032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct pktcdvd_kobj* pkt_kobj_create(struct pktcdvd_device *pd, 11132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier const char* name, 11232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct kobject* parent, 11332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct kobj_type* ktype) 11432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 11532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct pktcdvd_kobj *p; 11689c426066462263c90957c37af29765855516b83Greg Kroah-Hartman int error; 11789c426066462263c90957c37af29765855516b83Greg Kroah-Hartman 11832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier p = kzalloc(sizeof(*p), GFP_KERNEL); 11932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!p) 12032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return NULL; 12132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier p->pd = pd; 12289c426066462263c90957c37af29765855516b83Greg Kroah-Hartman error = kobject_init_and_add(&p->kobj, ktype, parent, "%s", name); 12389c426066462263c90957c37af29765855516b83Greg Kroah-Hartman if (error) { 124d17a18dd92c91c784fcf7c785fa6bbf178fd0a6dDave Young kobject_put(&p->kobj); 12532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return NULL; 126d17a18dd92c91c784fcf7c785fa6bbf178fd0a6dDave Young } 12789c426066462263c90957c37af29765855516b83Greg Kroah-Hartman kobject_uevent(&p->kobj, KOBJ_ADD); 12832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return p; 12932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 13032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* 13132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * remove a pktcdvd kernel object. 13232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier */ 13332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_kobj_remove(struct pktcdvd_kobj *p) 13432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 13532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (p) 136c10997f6575f476ff38442fa18fd4a0d80345f9dGreg Kroah-Hartman kobject_put(&p->kobj); 13732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 13832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* 13932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * default release function for pktcdvd kernel objects. 14032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier */ 14132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_kobj_release(struct kobject *kobj) 14232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 14332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier kfree(to_pktcdvdkobj(kobj)); 14432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 14532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 14632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 14732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/********************************************************** 14832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * 14932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * sysfs interface for pktcdvd 15032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * by (C) 2006 Thomas Maier <balagi@justmail.de> 15132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * 15232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier **********************************************************/ 15332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 15432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier#define DEF_ATTR(_obj,_name,_mode) \ 1557b595756ec1f49e0049a9e01a1298d53a7faaa15Tejun Heo static struct attribute _obj = { .name = _name, .mode = _mode } 15632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 15732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/********************************************************** 15832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier /sys/class/pktcdvd/pktcdvd[0-7]/ 15932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/reset 16032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/packets_started 16132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/packets_finished 16232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/kb_written 16332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/kb_read 16432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/kb_read_gather 16532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier write_queue/size 16632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier write_queue/congestion_off 16732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier write_queue/congestion_on 16832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier **********************************************************/ 16932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 17032694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st1, "reset", 0200); 17132694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st2, "packets_started", 0444); 17232694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st3, "packets_finished", 0444); 17332694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st4, "kb_written", 0444); 17432694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st5, "kb_read", 0444); 17532694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st6, "kb_read_gather", 0444); 17632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 17732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct attribute *kobj_pkt_attrs_stat[] = { 17832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st1, 17932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st2, 18032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st3, 18132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st4, 18232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st5, 18332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st6, 18432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier NULL 18532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 18632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 18732694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_wq1, "size", 0444); 18832694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_wq2, "congestion_off", 0644); 18932694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_wq3, "congestion_on", 0644); 19032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 19132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct attribute *kobj_pkt_attrs_wqueue[] = { 19232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_wq1, 19332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_wq2, 19432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_wq3, 19532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier NULL 19632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 19732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 19832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic ssize_t kobj_pkt_show(struct kobject *kobj, 19932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct attribute *attr, char *data) 20032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 20132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct pktcdvd_device *pd = to_pktcdvdkobj(kobj)->pd; 20232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int n = 0; 20332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int v; 20432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (strcmp(attr->name, "packets_started") == 0) { 20532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.pkt_started); 20632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 20732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "packets_finished") == 0) { 20832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.pkt_ended); 20932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 21032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "kb_written") == 0) { 21132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.secs_w >> 1); 21232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 21332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "kb_read") == 0) { 21432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.secs_r >> 1); 21532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 21632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "kb_read_gather") == 0) { 21732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.secs_rg >> 1); 21832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 21932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "size") == 0) { 22032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 22132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier v = pd->bio_queue_size; 22232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 22332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%d\n", v); 22432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 22532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_off") == 0) { 22632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 22732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier v = pd->write_congestion_off; 22832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 22932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%d\n", v); 23032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 23132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_on") == 0) { 23232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 23332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier v = pd->write_congestion_on; 23432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 23532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%d\n", v); 23632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 23732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return n; 23832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 23932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 24032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void init_write_congestion_marks(int* lo, int* hi) 24132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 24232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (*hi > 0) { 24332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *hi = max(*hi, 500); 24432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *hi = min(*hi, 1000000); 24532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (*lo <= 0) 24632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = *hi - 100; 24732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier else { 24832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = min(*lo, *hi - 100); 24932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = max(*lo, 100); 25032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 25132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else { 25232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *hi = -1; 25332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = -1; 25432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 25532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 25632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 25732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic ssize_t kobj_pkt_store(struct kobject *kobj, 25832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct attribute *attr, 25932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier const char *data, size_t len) 26032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 26132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct pktcdvd_device *pd = to_pktcdvdkobj(kobj)->pd; 26232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int val; 26332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 26483f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier if (strcmp(attr->name, "reset") == 0 && len > 0) { 26532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.pkt_started = 0; 26632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.pkt_ended = 0; 26732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.secs_w = 0; 26832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.secs_rg = 0; 26932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.secs_r = 0; 27032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 27132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_off") == 0 27283f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier && sscanf(data, "%d", &val) == 1) { 27332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 27432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->write_congestion_off = val; 27532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier init_write_congestion_marks(&pd->write_congestion_off, 27632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &pd->write_congestion_on); 27732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 27832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 27932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_on") == 0 28083f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier && sscanf(data, "%d", &val) == 1) { 28132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 28232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->write_congestion_on = val; 28332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier init_write_congestion_marks(&pd->write_congestion_off, 28432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &pd->write_congestion_on); 28532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 28632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 28732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return len; 28832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 28932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 29052cf25d0ab7f78eeecc59ac652ed5090f69b619eEmese Revfystatic const struct sysfs_ops kobj_pkt_ops = { 29132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .show = kobj_pkt_show, 29232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .store = kobj_pkt_store 29332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 29432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct kobj_type kobj_pkt_type_stat = { 29532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .release = pkt_kobj_release, 29632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .sysfs_ops = &kobj_pkt_ops, 29732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .default_attrs = kobj_pkt_attrs_stat 29832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 29932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct kobj_type kobj_pkt_type_wqueue = { 30032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .release = pkt_kobj_release, 30132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .sysfs_ops = &kobj_pkt_ops, 30232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .default_attrs = kobj_pkt_attrs_wqueue 30332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 30432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 30532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_sysfs_dev_new(struct pktcdvd_device *pd) 30632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 30732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (class_pktcdvd) { 308cba767175becadc5c4016cceb7bfdd2c7fe722f4Kay Sievers pd->dev = device_create(class_pktcdvd, NULL, MKDEV(0, 0), NULL, 3091ff9f542e5f87c299226557ce5e67a402ed4b502Greg Kroah-Hartman "%s", pd->name); 3106013c12be8313b3205b41912d965b03f3b06147dTony Jones if (IS_ERR(pd->dev)) 3116013c12be8313b3205b41912d965b03f3b06147dTony Jones pd->dev = NULL; 31232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 3136013c12be8313b3205b41912d965b03f3b06147dTony Jones if (pd->dev) { 31432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->kobj_stat = pkt_kobj_create(pd, "stat", 3156013c12be8313b3205b41912d965b03f3b06147dTony Jones &pd->dev->kobj, 31632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_type_stat); 31732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->kobj_wqueue = pkt_kobj_create(pd, "write_queue", 3186013c12be8313b3205b41912d965b03f3b06147dTony Jones &pd->dev->kobj, 31932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_type_wqueue); 32032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 32132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 32232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 32332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_sysfs_dev_remove(struct pktcdvd_device *pd) 32432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 32532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_kobj_remove(pd->kobj_stat); 32632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_kobj_remove(pd->kobj_wqueue); 32732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (class_pktcdvd) 328ca0bf64d99f6e3f6e2fe2585e52a0ac57354beacThadeu Lima de Souza Cascardo device_unregister(pd->dev); 32932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 33032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 33132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 33232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/******************************************************************** 33332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier /sys/class/pktcdvd/ 33432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier add map block device 33532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier remove unmap packet dev 33632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier device_map show mappings 33732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *******************************************************************/ 33832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 33932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void class_pktcdvd_release(struct class *cls) 34032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 34132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier kfree(cls); 34232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 34328812fe11a21826ba4c97c6c7971a619987cd912Andi Kleenstatic ssize_t class_pktcdvd_show_map(struct class *c, 34428812fe11a21826ba4c97c6c7971a619987cd912Andi Kleen struct class_attribute *attr, 34528812fe11a21826ba4c97c6c7971a619987cd912Andi Kleen char *data) 34632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 34732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int n = 0; 34832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int idx; 34932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 35032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier for (idx = 0; idx < MAX_WRITERS; idx++) { 35132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct pktcdvd_device *pd = pkt_devs[idx]; 35232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!pd) 35332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier continue; 35432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n += sprintf(data+n, "%s %u:%u %u:%u\n", 35532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->name, 35632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier MAJOR(pd->pkt_dev), MINOR(pd->pkt_dev), 35732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier MAJOR(pd->bdev->bd_dev), 35832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier MINOR(pd->bdev->bd_dev)); 35932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 36032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier mutex_unlock(&ctl_mutex); 36132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return n; 36232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 36332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 36428812fe11a21826ba4c97c6c7971a619987cd912Andi Kleenstatic ssize_t class_pktcdvd_store_add(struct class *c, 36528812fe11a21826ba4c97c6c7971a619987cd912Andi Kleen struct class_attribute *attr, 36628812fe11a21826ba4c97c6c7971a619987cd912Andi Kleen const char *buf, 36732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier size_t count) 36832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 36932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier unsigned int major, minor; 370fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo 37183f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier if (sscanf(buf, "%u:%u", &major, &minor) == 2) { 372fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo /* pkt_setup_dev() expects caller to hold reference to self */ 373fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo if (!try_module_get(THIS_MODULE)) 374fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo return -ENODEV; 375fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo 37632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_setup_dev(MKDEV(major, minor), NULL); 377fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo 378fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo module_put(THIS_MODULE); 379fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo 38032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return count; 38132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 382fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo 38332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return -EINVAL; 38432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 38532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 38628812fe11a21826ba4c97c6c7971a619987cd912Andi Kleenstatic ssize_t class_pktcdvd_store_remove(struct class *c, 38728812fe11a21826ba4c97c6c7971a619987cd912Andi Kleen struct class_attribute *attr, 38828812fe11a21826ba4c97c6c7971a619987cd912Andi Kleen const char *buf, 38932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier size_t count) 39032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 39132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier unsigned int major, minor; 39283f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier if (sscanf(buf, "%u:%u", &major, &minor) == 2) { 39332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_remove_dev(MKDEV(major, minor)); 39432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return count; 39532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 39632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return -EINVAL; 39732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 39832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 39932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct class_attribute class_pktcdvd_attrs[] = { 40032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR(add, 0200, NULL, class_pktcdvd_store_add), 40132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR(remove, 0200, NULL, class_pktcdvd_store_remove), 40232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR(device_map, 0444, class_pktcdvd_show_map, NULL), 40332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR_NULL 40432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 40532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 40632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 40732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_sysfs_init(void) 40832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 40932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int ret = 0; 41032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 41132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier /* 41232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * create control files in sysfs 41332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * /sys/class/pktcdvd/... 41432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier */ 41532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd = kzalloc(sizeof(*class_pktcdvd), GFP_KERNEL); 41632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!class_pktcdvd) 41732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return -ENOMEM; 41832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->name = DRIVER_NAME; 41932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->owner = THIS_MODULE; 42032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->class_release = class_pktcdvd_release; 42132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->class_attrs = class_pktcdvd_attrs; 42232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier ret = class_register(class_pktcdvd); 42332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (ret) { 42432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier kfree(class_pktcdvd); 42532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd = NULL; 42632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier printk(DRIVER_NAME": failed to create class pktcdvd\n"); 42732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return ret; 42832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 42932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return 0; 43032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 43132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 43232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_sysfs_cleanup(void) 43332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 43432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (class_pktcdvd) 43532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_destroy(class_pktcdvd); 43632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd = NULL; 43732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 43832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 43932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/******************************************************************** 44032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier entries in debugfs 44132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 442156f5a7801195fa2ce44aeeb62d6cf8468f3332aGeunSik Lim /sys/kernel/debug/pktcdvd[0-7]/ 44332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier info 44432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 44532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *******************************************************************/ 44632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 44732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_debugfs_seq_show(struct seq_file *m, void *p) 44832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 44932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return pkt_seq_show(m, p); 45032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 45132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 45232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_debugfs_fops_open(struct inode *inode, struct file *file) 45332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 45432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return single_open(file, pkt_debugfs_seq_show, inode->i_private); 45532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 45632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 4572b8693c0617e972fc0b2fd1ebf8de97e15b656c3Arjan van de Venstatic const struct file_operations debug_fops = { 45832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .open = pkt_debugfs_fops_open, 45932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .read = seq_read, 46032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .llseek = seq_lseek, 46132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .release = single_release, 46232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .owner = THIS_MODULE, 46332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 46432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 46532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_dev_new(struct pktcdvd_device *pd) 46632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 46732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!pkt_debugfs_root) 46832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 46932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_f_info = NULL; 47032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_d_root = debugfs_create_dir(pd->name, pkt_debugfs_root); 47132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (IS_ERR(pd->dfs_d_root)) { 47232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_d_root = NULL; 47332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 47432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 47532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_f_info = debugfs_create_file("info", S_IRUGO, 47632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_d_root, pd, &debug_fops); 47732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (IS_ERR(pd->dfs_f_info)) { 47832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_f_info = NULL; 47932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 48032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 48132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 48232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 48332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_dev_remove(struct pktcdvd_device *pd) 48432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 48532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!pkt_debugfs_root) 48632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 48732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (pd->dfs_f_info) 48832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier debugfs_remove(pd->dfs_f_info); 48932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_f_info = NULL; 49032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (pd->dfs_d_root) 49132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier debugfs_remove(pd->dfs_d_root); 49232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_d_root = NULL; 49332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 49432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 49532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_init(void) 49632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 49732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_root = debugfs_create_dir(DRIVER_NAME, NULL); 49832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (IS_ERR(pkt_debugfs_root)) { 49932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_root = NULL; 50032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 50132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 50232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 50332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 50432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_cleanup(void) 50532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 50632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!pkt_debugfs_root) 50732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 50832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier debugfs_remove(pkt_debugfs_root); 50932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_root = NULL; 51032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 51132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 51232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* ----------------------------------------------------------*/ 51332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 5141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_bio_finished(struct pktcdvd_device *pd) 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(atomic_read(&pd->cdrw.pending_bios) <= 0); 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_dec_and_test(&pd->cdrw.pending_bios)) { 5197822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": queue empty\n"); 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->iosched.attention, 1); 5211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Allocate a packet_data struct 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 528e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlundstatic struct packet_data *pkt_alloc_packet_data(int frames) 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 5311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 5321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5331107d2e0352769b9bde6a4877c295b9309cdb877Peter Osterlund pkt = kzalloc(sizeof(struct packet_data), GFP_KERNEL); 5341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt) 5351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_pkt; 5361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 537e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund pkt->frames = frames; 538ccc5c9ca6aac08218b1ba52afd07a1a9864c8c5dKent Overstreet pkt->w_bio = bio_kmalloc(GFP_KERNEL, frames); 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt->w_bio) 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_bio; 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 542e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames / FRAMES_PER_PAGE; i++) { 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->pages[i] = alloc_page(GFP_KERNEL|__GFP_ZERO); 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt->pages[i]) 5451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_page; 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_init(&pkt->lock); 549c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_init(&pkt->orig_bios); 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 551e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames; i++) { 552ccc5c9ca6aac08218b1ba52afd07a1a9864c8c5dKent Overstreet struct bio *bio = bio_kmalloc(GFP_KERNEL, 1); 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio) 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_rd_bio; 555ccc5c9ca6aac08218b1ba52afd07a1a9864c8c5dKent Overstreet 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->r_bios[i] = bio; 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt; 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_rd_bio: 562e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames; i++) { 5631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio = pkt->r_bios[i]; 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio) 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(bio); 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_page: 569e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames / FRAMES_PER_PAGE; i++) 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->pages[i]) 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __free_page(pkt->pages[i]); 5721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(pkt->w_bio); 5731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_bio: 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pkt); 5751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_pkt: 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 5771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Free a packet_data struct 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_free_packet_data(struct packet_data *pkt) 5831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 5851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 586e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < pkt->frames; i++) { 5871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio = pkt->r_bios[i]; 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio) 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(bio); 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 591e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < pkt->frames / FRAMES_PER_PAGE; i++) 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __free_page(pkt->pages[i]); 5931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(pkt->w_bio); 5941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pkt); 5951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_shrink_pktlist(struct pktcdvd_device *pd) 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt, *next; 6001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!list_empty(&pd->cdrw.pkt_active_list)); 6021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry_safe(pkt, next, &pd->cdrw.pkt_free_list, list) { 6041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_free_packet_data(pkt); 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 606e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund INIT_LIST_HEAD(&pd->cdrw.pkt_free_list); 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_grow_pktlist(struct pktcdvd_device *pd, int nr_packets) 6101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 613e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund BUG_ON(!list_empty(&pd->cdrw.pkt_free_list)); 614e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (nr_packets > 0) { 616e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund pkt = pkt_alloc_packet_data(pd->settings.size >> 2); 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt) { 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_shrink_pktlist(pd); 6191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 6201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->id = nr_packets; 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->pd = pd; 6231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add(&pkt->list, &pd->cdrw.pkt_free_list); 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds nr_packets--; 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 6271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline struct pkt_rb_node *pkt_rbtree_next(struct pkt_rb_node *node) 6301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *n = rb_next(&node->rb_node); 6321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!n) 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 6341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rb_entry(n, struct pkt_rb_node, rb_node); 6351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 637ac893963030ad70e528dc23270d499d650546a38Peter Osterlundstatic void pkt_rbtree_erase(struct pktcdvd_device *pd, struct pkt_rb_node *node) 6381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rb_erase(&node->rb_node, &pd->bio_queue); 6401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_free(node, pd->rb_pool); 6411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bio_queue_size--; 6421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->bio_queue_size < 0); 6431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 6461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Find the first node in the pd->bio_queue rb tree with a starting sector >= s. 6471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 6481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct pkt_rb_node *pkt_rbtree_find(struct pktcdvd_device *pd, sector_t s) 6491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *n = pd->bio_queue.rb_node; 6511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *next; 6521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *tmp; 6531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!n) { 6551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->bio_queue_size > 0); 6561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 6571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 6601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = rb_entry(n, struct pkt_rb_node, rb_node); 6611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (s <= tmp->bio->bi_sector) 6621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds next = n->rb_left; 6631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 6641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds next = n->rb_right; 6651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!next) 6661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds n = next; 6681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (s > tmp->bio->bi_sector) { 6711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = pkt_rbtree_next(tmp); 6721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!tmp) 6731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 6741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(s > tmp->bio->bi_sector); 6761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return tmp; 6771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 6801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Insert a node into the pd->bio_queue rb tree. 6811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 6821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_rbtree_insert(struct pktcdvd_device *pd, struct pkt_rb_node *node) 6831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node **p = &pd->bio_queue.rb_node; 6851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *parent = NULL; 6861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t s = node->bio->bi_sector; 6871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *tmp; 6881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (*p) { 6901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds parent = *p; 6911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = rb_entry(parent, struct pkt_rb_node, rb_node); 6921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (s < tmp->bio->bi_sector) 6931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = &(*p)->rb_left; 6941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 6951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = &(*p)->rb_right; 6961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rb_link_node(&node->rb_node, parent, p); 6981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rb_insert_color(&node->rb_node, &pd->bio_queue); 6991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bio_queue_size++; 7001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Send a packet_command to the underlying block device and 7041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * wait for completion. 7051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_generic_packet(struct pktcdvd_device *pd, struct packet_command *cgc) 7071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 708165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboe struct request_queue *q = bdev_get_queue(pd->bdev); 7091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request *rq; 710406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig int ret = 0; 711406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig 712406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig rq = blk_get_request(q, (cgc->data_direction == CGC_DATA_WRITE) ? 713406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig WRITE : READ, __GFP_WAIT); 714406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig 715406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig if (cgc->buflen) { 716406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig if (blk_rq_map_kern(q, rq, cgc->buffer, cgc->buflen, __GFP_WAIT)) 717406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig goto out; 718406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig } 7191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 72091e4ee381d23ef67196a03924485aeceb32d6753Gerhard Dirschl rq->cmd_len = COMMAND_SIZE(cgc->cmd[0]); 721406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig memcpy(rq->cmd, cgc->cmd, CDROM_PACKET_SIZE); 7221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rq->timeout = 60*HZ; 7244aff5e2333c9a1609662f2091f55c3f6fffdad36Jens Axboe rq->cmd_type = REQ_TYPE_BLOCK_PC; 7251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cgc->quiet) 7264aff5e2333c9a1609662f2091f55c3f6fffdad36Jens Axboe rq->cmd_flags |= REQ_QUIET; 7271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 728406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig blk_execute_rq(rq->q, pd->bdev->bd_disk, rq, 0); 729cbc31a475a7f7748bd0a4e536533868e7cff8645Andrew Morton if (rq->errors) 730cbc31a475a7f7748bd0a4e536533868e7cff8645Andrew Morton ret = -EIO; 731406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwigout: 7321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_put_request(rq); 733406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig return ret; 7341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * A generic sense dump / resolve mechanism should be implemented across 7381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * all ATAPI + SCSI devices. 7391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_dump_sense(struct packet_command *cgc) 7411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds static char *info[9] = { "No sense", "Recovered error", "Not ready", 7431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "Medium error", "Hardware error", "Illegal request", 7441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "Unit attention", "Data protect", "Blank check" }; 7451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 7461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense *sense = cgc->sense; 7471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7487822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME":"); 7491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < CDROM_PACKET_SIZE; i++) 7501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(" %02x", cgc->cmd[i]); 7511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(" - "); 7521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sense == NULL) { 7541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("no sense\n"); 7551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 7561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("sense %02x.%02x.%02x", sense->sense_key, sense->asc, sense->ascq); 7591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sense->sense_key > 8) { 7611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(" (INVALID)\n"); 7621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 7631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(" (%s)\n", info[sense->sense_key]); 7661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * flush the drive cache to media 7701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_flush_cache(struct pktcdvd_device *pd) 7721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 7741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 7761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_FLUSH_CACHE; 7771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 7781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 7801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the IMMED bit -- we default to not setting it, although that 7811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * would allow a much faster close, this is safer 7821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 0 7841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 1 << 1; 7851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 7861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 7871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * speed is given as the normal factor, e.g. 4 for 4x 7911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 79205680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_set_speed(struct pktcdvd_device *pd, 79305680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlund unsigned write_speed, unsigned read_speed) 7941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 7961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 7971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 7981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 8001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 8011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_SET_SPEED; 8021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[2] = (read_speed >> 8) & 0xff; 8031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[3] = read_speed & 0xff; 8041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[4] = (write_speed >> 8) & 0xff; 8051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[5] = write_speed & 0xff; 8061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 8081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 8091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 8111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 8141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Queue a bio for processing by the low-level CD device. Must be called 8151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * from process context. 8161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 81746c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlundstatic void pkt_queue_bio(struct pktcdvd_device *pd, struct bio *bio) 8181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->iosched.lock); 820c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita if (bio_data_dir(bio) == READ) 821c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_add(&pd->iosched.read_queue, bio); 822c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita else 823c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_add(&pd->iosched.write_queue, bio); 8241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->iosched.lock); 8251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->iosched.attention, 1); 8271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 8281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 8311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Process the queued read/write requests. This function handles special 8321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * requirements for CDRW drives: 8331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * - A cache flush command must be inserted before a read request if the 8341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * previous request was a write. 83546c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * - Switching between reading and writing is slow, so don't do it more often 8361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * than necessary. 83746c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * - Optimize for throughput at the expense of latency. This means that streaming 83846c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * writes will never be interrupted by a read, but if the drive has to seek 83946c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * before the next write, switch to reading instead if there are any pending 84046c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * read requests. 8411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * - Set the read speed according to current usage pattern. When only reading 8421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * from the device, it's best to use the highest possible read speed, but 8431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * when switching often between reading and writing, it's better to have the 8441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * same read and write speeds. 8451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 8461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_iosched_process_queue(struct pktcdvd_device *pd) 8471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->iosched.attention) == 0) 8501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 8511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->iosched.attention, 0); 8521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 8541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio; 85546c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund int reads_queued, writes_queued; 8561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->iosched.lock); 858c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita reads_queued = !bio_list_empty(&pd->iosched.read_queue); 859c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita writes_queued = !bio_list_empty(&pd->iosched.write_queue); 8601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->iosched.lock); 8611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!reads_queued && !writes_queued) 8631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 8641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->iosched.writing) { 86646c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund int need_write_seek = 1; 86746c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund spin_lock(&pd->iosched.lock); 868c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio = bio_list_peek(&pd->iosched.write_queue); 86946c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund spin_unlock(&pd->iosched.lock); 87046c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund if (bio && (bio->bi_sector == pd->iosched.last_write)) 87146c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund need_write_seek = 0; 87246c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund if (need_write_seek && reads_queued) { 8731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->cdrw.pending_bios) > 0) { 8747822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": write, waiting\n"); 8751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 8761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_flush_cache(pd); 8781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->iosched.writing = 0; 8791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 8811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!reads_queued && writes_queued) { 8821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->cdrw.pending_bios) > 0) { 8837822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": read, waiting\n"); 8841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 8851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->iosched.writing = 1; 8871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->iosched.lock); 891c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita if (pd->iosched.writing) 892c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio = bio_list_pop(&pd->iosched.write_queue); 893c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita else 894c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio = bio_list_pop(&pd->iosched.read_queue); 8951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->iosched.lock); 8961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio) 8981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 8991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio_data_dir(bio) == READ) 9011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->iosched.successive_reads += bio->bi_size >> 10; 90246c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund else { 9031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->iosched.successive_reads = 0; 904f73a1c7d117d07a96d89475066188a2b79e53c48Kent Overstreet pd->iosched.last_write = bio_end_sector(bio); 90546c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund } 9061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->iosched.successive_reads >= HI_SPEED_SWITCH) { 9071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->read_speed == pd->write_speed) { 9081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->read_speed = MAX_SPEED; 9091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, pd->write_speed, pd->read_speed); 9101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 9121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->read_speed != pd->write_speed) { 9131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->read_speed = pd->write_speed; 9141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, pd->write_speed, pd->read_speed); 9151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pd->cdrw.pending_bios); 9191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds generic_make_request(bio); 9201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 9241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Special care is needed if the underlying block device has a small 9251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * max_phys_segments value. 9261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 927165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboestatic int pkt_set_segment_merging(struct pktcdvd_device *pd, struct request_queue *q) 9281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 929ae03bf639a5027d27270123f5f6e3ee6a412781dMartin K. Petersen if ((pd->settings.size << 9) / CD_FRAMESIZE 9308a78362c4eefc1deddbefe2c7f38aabbc2429d6bMartin K. Petersen <= queue_max_segments(q)) { 9311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 9321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * The cdrom device can handle one segment/frame 9331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds clear_bit(PACKET_MERGE_SEGS, &pd->flags); 9351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 936ae03bf639a5027d27270123f5f6e3ee6a412781dMartin K. Petersen } else if ((pd->settings.size << 9) / PAGE_SIZE 9378a78362c4eefc1deddbefe2c7f38aabbc2429d6bMartin K. Petersen <= queue_max_segments(q)) { 9381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 9391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * We can handle this case at the expense of some extra memory 9401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * copies during write operations 9411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_MERGE_SEGS, &pd->flags); 9431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 9441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 9457822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": cdrom max_phys_segments too small\n"); 9461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 9471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 9511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copy CD_FRAMESIZE bytes from src_bio into a destination page 9521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_copy_bio_data(struct bio *src_bio, int seg, int offs, struct page *dst_page, int dst_offs) 9541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int copy_size = CD_FRAMESIZE; 9561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (copy_size > 0) { 9581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio_vec *src_bvl = bio_iovec_idx(src_bio, seg); 959cfd8005c99c68882e962807d36603791adddfb9fCong Wang void *vfrom = kmap_atomic(src_bvl->bv_page) + 9601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds src_bvl->bv_offset + offs; 9611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void *vto = page_address(dst_page) + dst_offs; 9621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int len = min_t(int, copy_size, src_bvl->bv_len - offs); 9631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(len < 0); 9651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy(vto, vfrom, len); 966cfd8005c99c68882e962807d36603791adddfb9fCong Wang kunmap_atomic(vfrom); 9671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seg++; 9691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offs = 0; 9701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dst_offs += len; 9711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds copy_size -= len; 9721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 9761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copy all data for this packet to pkt->pages[], so that 9771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * a) The number of required segments for the write bio is minimized, which 9781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is necessary for some scsi controllers. 9791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * b) The data can be used as cache to avoid read requests if we receive a 9801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * new write request for the same zone. 9811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9827277232374680595cdbc774fd246b206f56db015Peter Osterlundstatic void pkt_make_local_copy(struct packet_data *pkt, struct bio_vec *bvec) 9831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int f, p, offs; 9851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Copy all data to pkt->pages[] */ 9871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = 0; 9881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offs = 0; 9891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = 0; f < pkt->frames; f++) { 9907277232374680595cdbc774fd246b206f56db015Peter Osterlund if (bvec[f].bv_page != pkt->pages[p]) { 991cfd8005c99c68882e962807d36603791adddfb9fCong Wang void *vfrom = kmap_atomic(bvec[f].bv_page) + bvec[f].bv_offset; 9921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void *vto = page_address(pkt->pages[p]) + offs; 9931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy(vto, vfrom, CD_FRAMESIZE); 994cfd8005c99c68882e962807d36603791adddfb9fCong Wang kunmap_atomic(vfrom); 9957277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_page = pkt->pages[p]; 9967277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_offset = offs; 9971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 9987277232374680595cdbc774fd246b206f56db015Peter Osterlund BUG_ON(bvec[f].bv_offset != offs); 9991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offs += CD_FRAMESIZE; 10011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (offs >= PAGE_SIZE) { 10021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offs = 0; 10031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p++; 10041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10086712ecf8f648118c3363c142196418f89a510b90NeilBrownstatic void pkt_end_io_read(struct bio *bio, int err) 10091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt = bio->bi_private; 10111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = pkt->pd; 10121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!pd); 10131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_end_io_read: bio=%p sec0=%llx sec=%llx err=%d\n", bio, 10151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (unsigned long long)pkt->sector, (unsigned long long)bio->bi_sector, err); 10161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err) 10181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->io_errors); 10191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_dec_and_test(&pkt->io_wait)) { 10201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 10211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 10221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bio_finished(pd); 10241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10266712ecf8f648118c3363c142196418f89a510b90NeilBrownstatic void pkt_end_io_packet_write(struct bio *bio, int err) 10271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt = bio->bi_private; 10291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = pkt->pd; 10301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!pd); 10311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_end_io_packet_write: id=%d, err=%d\n", pkt->id, err); 10331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->stats.pkt_ended++; 10351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bio_finished(pd); 10371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_dec(&pkt->io_wait); 10381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 10391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 10401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 10431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Schedule reads for the holes in a packet 10441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 10451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_gather_data(struct pktcdvd_device *pd, struct packet_data *pkt) 10461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int frames_read = 0; 10481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio; 10491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int f; 10501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char written[PACKET_MAX_SIZE]; 10511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1052c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita BUG_ON(bio_list_empty(&pkt->orig_bios)); 10531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->io_wait, 0); 10551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->io_errors, 0); 10561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 10581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Figure out which frames we need to read before we can write. 10591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 10601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(written, 0, sizeof(written)); 10611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 1062c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_for_each(bio, &pkt->orig_bios) { 10631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int first_frame = (bio->bi_sector - pkt->sector) / (CD_FRAMESIZE >> 9); 10641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int num_frames = bio->bi_size / CD_FRAMESIZE; 106506e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund pd->stats.secs_w += num_frames * (CD_FRAMESIZE >> 9); 10661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(first_frame < 0); 10671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(first_frame + num_frames > pkt->frames); 10681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = first_frame; f < first_frame + num_frames; f++) 10691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds written[f] = 1; 10701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 10721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 107306e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund if (pkt->cache_valid) { 107406e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund VPRINTK("pkt_gather_data: zone %llx cached\n", 107506e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund (unsigned long long)pkt->sector); 107606e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund goto out_account; 107706e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund } 107806e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund 10791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 10801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Schedule reads for missing parts of the packet. 10811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 10821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = 0; f < pkt->frames; f++) { 10831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int p, offset; 1084ccc5c9ca6aac08218b1ba52afd07a1a9864c8c5dKent Overstreet 10851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (written[f]) 10861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 1087ccc5c9ca6aac08218b1ba52afd07a1a9864c8c5dKent Overstreet 10881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = pkt->r_bios[f]; 1089ccc5c9ca6aac08218b1ba52afd07a1a9864c8c5dKent Overstreet bio_reset(bio); 10901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_sector = pkt->sector + f * (CD_FRAMESIZE >> 9); 10911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_bdev = pd->bdev; 10921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_end_io = pkt_end_io_read; 10931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_private = pkt; 10941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = (f * CD_FRAMESIZE) / PAGE_SIZE; 10961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = (f * CD_FRAMESIZE) % PAGE_SIZE; 10971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_gather_data: Adding frame %d, page:%p offs:%d\n", 10981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds f, pkt->pages[p], offset); 10991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio_add_page(bio, pkt->pages[p], CD_FRAMESIZE, offset)) 11001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG(); 11011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->io_wait); 11031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_rw = READ; 110446c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund pkt_queue_bio(pd, bio); 11051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_read++; 11061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_account: 11091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_gather_data: need %d frames for zone %llx\n", 11101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_read, (unsigned long long)pkt->sector); 11111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->stats.pkt_started++; 11121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->stats.secs_rg += frames_read * (CD_FRAMESIZE >> 9); 11131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 11161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Find a packet matching zone, or the least recently used packet if 11171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * there is no match. 11181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 11191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct packet_data *pkt_get_packet_data(struct pktcdvd_device *pd, int zone) 11201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 11221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_free_list, list) { 11241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sector == zone || pkt->list.next == &pd->cdrw.pkt_free_list) { 11251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_del_init(&pkt->list); 11261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sector != zone) 11271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 0; 1128610827dee82731c7be5a135d750d194ac56881a9Peter Osterlund return pkt; 11291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1131610827dee82731c7be5a135d750d194ac56881a9Peter Osterlund BUG(); 1132610827dee82731c7be5a135d750d194ac56881a9Peter Osterlund return NULL; 11331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_put_packet_data(struct pktcdvd_device *pd, struct packet_data *pkt) 11361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->cache_valid) { 11381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add(&pkt->list, &pd->cdrw.pkt_free_list); 11391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 11401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add_tail(&pkt->list, &pd->cdrw.pkt_free_list); 11411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 11451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * recover a failed write, query for relocation if possible 11461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 11471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * returns 1 if recovery is possible, or 0 if not 11481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 11491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 11501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_start_recovery(struct packet_data *pkt) 11511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 11531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * FIXME. We need help from the file system to implement 11541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * recovery handling. 11551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 11561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 11571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 0 11581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request *rq = pkt->rq; 11591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = rq->rq_disk->private_data; 11601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct block_device *pkt_bdev; 11611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct super_block *sb = NULL; 11621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long old_block, new_block; 11631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t new_sector; 11641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bdev = bdget(kdev_t_to_nr(pd->pkt_dev)); 11661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt_bdev) { 11671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sb = get_super(pkt_bdev); 11681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdput(pkt_bdev); 11691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!sb) 11721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 11731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1174e7f59097071f2e193e900093742a4be85839f3d9Al Viro if (!sb->s_op->relocate_blocks) 11751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 11761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds old_block = pkt->sector / (CD_FRAMESIZE >> 9); 11781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sb->s_op->relocate_blocks(sb, old_block, &new_block)) 11791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 11801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds new_sector = new_block * (CD_FRAMESIZE >> 9); 11821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sector = new_sector; 11831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->bio->bi_sector = new_sector; 11851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->bio->bi_next = NULL; 11861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->bio->bi_flags = 1 << BIO_UPTODATE; 11871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->bio->bi_idx = 0; 11881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11897b6d91daee5cac6402186ff224c3af39d79f4a0eChristoph Hellwig BUG_ON(pkt->bio->bi_rw != REQ_WRITE); 11901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pkt->bio->bi_vcnt != pkt->frames); 11911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pkt->bio->bi_size != pkt->frames * CD_FRAMESIZE); 11921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pkt->bio->bi_end_io != pkt_end_io_packet_write); 11931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pkt->bio->bi_private != pkt); 11941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds drop_super(sb); 11961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 11971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 11991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds drop_super(sb); 12001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 12011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 12021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 12031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void pkt_set_state(struct packet_data *pkt, enum packet_data_state state) 12051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 12061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if PACKET_DEBUG > 1 12071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds static const char *state_name[] = { 12081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "IDLE", "WAITING", "READ_WAIT", "WRITE_WAIT", "RECOVERY", "FINISHED" 12091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }; 12101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds enum packet_data_state old_state = pkt->state; 12111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt %2d : s=%6llx %s -> %s\n", pkt->id, (unsigned long long)pkt->sector, 12121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds state_name[old_state], state_name[state]); 12131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 12141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->state = state; 12151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 12161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 12181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Scan the work queue to see if we can start a new packet. 12191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * returns non-zero if any work was done. 12201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 12211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_handle_queue(struct pktcdvd_device *pd) 12221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 12231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt, *p; 12241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio = NULL; 12251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t zone = 0; /* Suppress gcc warning */ 12261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *node, *first_node; 12271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *n; 12280a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier int wakeup; 12291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("handle_queue\n"); 12311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->scan_queue, 0); 12331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (list_empty(&pd->cdrw.pkt_free_list)) { 12351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("handle_queue: no pkt\n"); 12361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 12371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 12401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Try to find a zone we are not already working on. 12411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 12421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->lock); 12431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds first_node = pkt_rbtree_find(pd, pd->current_sector); 12441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!first_node) { 12451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds n = rb_first(&pd->bio_queue); 12461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (n) 12471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds first_node = rb_entry(n, struct pkt_rb_node, rb_node); 12481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = first_node; 12501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (node) { 12511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = node->bio; 12521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds zone = ZONE(bio->bi_sector, pd); 12531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(p, &pd->cdrw.pkt_active_list, list) { 12547baeb6a5ccab2d472679a053e64a63ac423c3a42Peter Osterlund if (p->sector == zone) { 12557baeb6a5ccab2d472679a053e64a63ac423c3a42Peter Osterlund bio = NULL; 12561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto try_next_bio; 12577baeb6a5ccab2d472679a053e64a63ac423c3a42Peter Osterlund } 12581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 12601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldstry_next_bio: 12611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = pkt_rbtree_next(node); 12621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!node) { 12631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds n = rb_first(&pd->bio_queue); 12641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (n) 12651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = rb_entry(n, struct pkt_rb_node, rb_node); 12661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (node == first_node) 12681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = NULL; 12691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->lock); 12711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio) { 12721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("handle_queue: no bio\n"); 12731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 12741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt = pkt_get_packet_data(pd, zone); 12771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->current_sector = zone + pd->settings.size; 12791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sector = zone; 1280e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund BUG_ON(pkt->frames != pd->settings.size >> 2); 12811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->write_size = 0; 12821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 12841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Scan work queue for bios in the same zone and link them 12851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * to this packet. 12861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 12871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->lock); 12881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_handle_queue: looking for zone %llx\n", (unsigned long long)zone); 12891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while ((node = pkt_rbtree_find(pd, zone)) != NULL) { 12901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = node->bio; 12911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_handle_queue: found zone=%llx\n", 12921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (unsigned long long)ZONE(bio->bi_sector, pd)); 12931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ZONE(bio->bi_sector, pd) != zone) 12941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 12951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_rbtree_erase(pd, node); 12961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 1297c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_add(&pkt->orig_bios, bio); 12981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->write_size += bio->bi_size / CD_FRAMESIZE; 12991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 13001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13010a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier /* check write congestion marks, and if bio_queue_size is 13020a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier below, wake up any waiters */ 13030a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier wakeup = (pd->write_congestion_on > 0 13040a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier && pd->bio_queue_size <= pd->write_congestion_off); 13051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->lock); 13068aa7e847d834ed937a9ad37a0f2ad5b8584c1ab0Jens Axboe if (wakeup) { 13078aa7e847d834ed937a9ad37a0f2ad5b8584c1ab0Jens Axboe clear_bdi_congested(&pd->disk->queue->backing_dev_info, 13088aa7e847d834ed937a9ad37a0f2ad5b8584c1ab0Jens Axboe BLK_RW_ASYNC); 13098aa7e847d834ed937a9ad37a0f2ad5b8584c1ab0Jens Axboe } 13101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time = max(PACKET_WAIT_TIME, 1); 13121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_WAITING_STATE); 13131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->run_sm, 1); 13141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 13161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add(&pkt->list, &pd->cdrw.pkt_active_list); 13171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 13181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 13201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 13211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 13231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Assemble a bio to write one packet and queue the bio for processing 13241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * by the underlying block device. 13251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 13261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_start_write(struct pktcdvd_device *pd, struct packet_data *pkt) 13271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 13281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio; 13291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int f; 13301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int frames_write; 13317277232374680595cdbc774fd246b206f56db015Peter Osterlund struct bio_vec *bvec = pkt->w_bio->bi_io_vec; 13321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = 0; f < pkt->frames; f++) { 13347277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_page = pkt->pages[(f * CD_FRAMESIZE) / PAGE_SIZE]; 13357277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_offset = (f * CD_FRAMESIZE) % PAGE_SIZE; 13361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 13397277232374680595cdbc774fd246b206f56db015Peter Osterlund * Fill-in bvec with data from orig_bios. 13401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 13411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_write = 0; 13421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 1343c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_for_each(bio, &pkt->orig_bios) { 13441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int segment = bio->bi_idx; 13451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int src_offs = 0; 13461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int first_frame = (bio->bi_sector - pkt->sector) / (CD_FRAMESIZE >> 9); 13471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int num_frames = bio->bi_size / CD_FRAMESIZE; 13481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(first_frame < 0); 13491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(first_frame + num_frames > pkt->frames); 13501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = first_frame; f < first_frame + num_frames; f++) { 13511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio_vec *src_bvl = bio_iovec_idx(bio, segment); 13521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (src_offs >= src_bvl->bv_len) { 13541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds src_offs -= src_bvl->bv_len; 13551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds segment++; 13561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(segment >= bio->bi_vcnt); 13571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds src_bvl = bio_iovec_idx(bio, segment); 13581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (src_bvl->bv_len - src_offs >= CD_FRAMESIZE) { 13617277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_page = src_bvl->bv_page; 13627277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_offset = src_bvl->bv_offset + src_offs; 13631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 13641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_copy_bio_data(bio, segment, src_offs, 13657277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_page, bvec[f].bv_offset); 13661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds src_offs += CD_FRAMESIZE; 13681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_write++; 13691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_WRITE_WAIT_STATE); 13721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 13731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_start_write: Writing %d frames for zone %llx\n", 13751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_write, (unsigned long long)pkt->sector); 13761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(frames_write != pkt->write_size); 13771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (test_bit(PACKET_MERGE_SEGS, &pd->flags) || (pkt->write_size < pkt->frames)) { 13797277232374680595cdbc774fd246b206f56db015Peter Osterlund pkt_make_local_copy(pkt, bvec); 13801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 1; 13811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 13821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 0; 13831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Start the write request */ 1386ccc5c9ca6aac08218b1ba52afd07a1a9864c8c5dKent Overstreet bio_reset(pkt->w_bio); 13871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_sector = pkt->sector; 13881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_bdev = pd->bdev; 13891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_end_io = pkt_end_io_packet_write; 13901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_private = pkt; 13917277232374680595cdbc774fd246b206f56db015Peter Osterlund for (f = 0; f < pkt->frames; f++) 13927277232374680595cdbc774fd246b206f56db015Peter Osterlund if (!bio_add_page(pkt->w_bio, bvec[f].bv_page, CD_FRAMESIZE, bvec[f].bv_offset)) 13937277232374680595cdbc774fd246b206f56db015Peter Osterlund BUG(); 13947822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": vcnt=%d\n", pkt->w_bio->bi_vcnt); 13951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->io_wait, 1); 13971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_rw = WRITE; 139846c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund pkt_queue_bio(pd, pkt->w_bio); 13991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 14001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_finish_packet(struct packet_data *pkt, int uptodate) 14021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1403c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita struct bio *bio; 14041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!uptodate) 14061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 0; 14071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Finish all bios corresponding to this packet */ 1409c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita while ((bio = bio_list_pop(&pkt->orig_bios))) 14106712ecf8f648118c3363c142196418f89a510b90NeilBrown bio_endio(bio, uptodate ? 0 : -EIO); 14111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 14121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_run_state_machine(struct pktcdvd_device *pd, struct packet_data *pkt) 14141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 14151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int uptodate; 14161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("run_state_machine: pkt %d\n", pkt->id); 14181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 14201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (pkt->state) { 14211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_WAITING_STATE: 14221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pkt->write_size < pkt->frames) && (pkt->sleep_time > 0)) 14231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 14241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time = 0; 14261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_gather_data(pd, pkt); 14271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_READ_WAIT_STATE); 14281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 14291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_READ_WAIT_STATE: 14311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->io_wait) > 0) 14321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 14331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->io_errors) > 0) { 14351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_RECOVERY_STATE); 14361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 14371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_start_write(pd, pkt); 14381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 14401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_WRITE_WAIT_STATE: 14421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->io_wait) > 0) 14431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 14441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (test_bit(BIO_UPTODATE, &pkt->w_bio->bi_flags)) { 14461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_FINISHED_STATE); 14471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 14481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_RECOVERY_STATE); 14491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 14511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_RECOVERY_STATE: 14531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt_start_recovery(pkt)) { 14541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_start_write(pd, pkt); 14551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 14561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("No recovery possible\n"); 14571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_FINISHED_STATE); 14581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 14601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_FINISHED_STATE: 14621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uptodate = test_bit(BIO_UPTODATE, &pkt->w_bio->bi_flags); 14631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_finish_packet(pkt, uptodate); 14641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 14651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 14671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG(); 14681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 14691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 14721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_handle_packets(struct pktcdvd_device *pd) 14741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 14751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt, *next; 14761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_handle_packets\n"); 14781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 14801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Run state machine for active packets 14811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 14821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 14831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->run_sm) > 0) { 14841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->run_sm, 0); 14851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_run_state_machine(pd, pkt); 14861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 14901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Move no longer active packets to the free list 14911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 14921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 14931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry_safe(pkt, next, &pd->cdrw.pkt_active_list, list) { 14941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->state == PACKET_FINISHED_STATE) { 14951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_del(&pkt->list); 14961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_put_packet_data(pd, pkt); 14971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_IDLE_STATE); 14981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->scan_queue, 1); 14991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 15021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_count_states(struct pktcdvd_device *pd, int *states) 15051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 15061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 15071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 15081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1509ae7642bb05623988d8ca82b332dad1ed7bdb8cebPeter Osterlund for (i = 0; i < PACKET_NUM_STATES; i++) 15101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[i] = 0; 15111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 15131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 15141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[pkt->state]++; 15151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 15171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 15201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * kcdrwd is woken up when writes have been queued for one of our 15211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * registered devices 15221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 15231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int kcdrwd(void *foobar) 15241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 15251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = foobar; 15261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 15271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds long min_sleep_time, residue; 15281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_user_nice(current, -20); 1530831441862956fffa17b9801db37e6ea1650b0f69Rafael J. Wysocki set_freezable(); 15311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 15331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DECLARE_WAITQUEUE(wait, current); 15341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 15361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Wait until there is something to do 15371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 15381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_wait_queue(&pd->wqueue, &wait); 15391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 15401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_current_state(TASK_INTERRUPTIBLE); 15411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check if we need to run pkt_handle_queue */ 15431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->scan_queue) > 0) 15441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto work_to_do; 15451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check if we need to run the state machine for some packet */ 15471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 15481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->run_sm) > 0) 15491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto work_to_do; 15501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check if we need to process the iosched queues */ 15531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->iosched.attention) != 0) 15541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto work_to_do; 15551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Otherwise, go to sleep */ 15571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (PACKET_DEBUG > 1) { 15581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int states[PACKET_NUM_STATES]; 15591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_count_states(pd, states); 15601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("kcdrwd: i:%d ow:%d rw:%d ww:%d rec:%d fin:%d\n", 15611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[0], states[1], states[2], states[3], 15621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[4], states[5]); 15631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds min_sleep_time = MAX_SCHEDULE_TIMEOUT; 15661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 15671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sleep_time && pkt->sleep_time < min_sleep_time) 15681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds min_sleep_time = pkt->sleep_time; 15691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("kcdrwd: sleeping\n"); 15721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds residue = schedule_timeout(min_sleep_time); 15731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("kcdrwd: wake up\n"); 15741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* make swsusp happy with our thread */ 15763e1d1d28d99dabe63c64f7f40f1ca1d646de1f73Christoph Lameter try_to_freeze(); 15771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 15791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt->sleep_time) 15801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 15811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time -= min_sleep_time - residue; 15821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sleep_time <= 0) { 15831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time = 0; 15841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 15851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (kthread_should_stop()) 15891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 15901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldswork_to_do: 15921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_current_state(TASK_RUNNING); 15931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remove_wait_queue(&pd->wqueue, &wait); 15941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (kthread_should_stop()) 15961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 15971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 15991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * if pkt_handle_queue returns true, we can queue 16001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * another request. 16011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 16021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (pkt_handle_queue(pd)) 16031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ; 16041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 16061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Handle packet state machine 16071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 16081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_handle_packets(pd); 16091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 16111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Handle iosched queues 16121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 16131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_iosched_process_queue(pd); 16141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 16171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 16181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_print_settings(struct pktcdvd_device *pd) 16201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16217822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": %s packets, ", pd->settings.fp ? "Fixed" : "Variable"); 16221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("%u blocks, ", pd->settings.size >> 2); 16231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("Mode-%c disc\n", pd->settings.block_mode == 8 ? '1' : '2'); 16241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 16251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_mode_sense(struct pktcdvd_device *pd, struct packet_command *cgc, int page_code, int page_control) 16271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(cgc->cmd, 0, sizeof(cgc->cmd)); 16291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[0] = GPCMD_MODE_SENSE_10; 16311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[2] = page_code | (page_control << 6); 16321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[7] = cgc->buflen >> 8; 16331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[8] = cgc->buflen & 0xff; 16341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->data_direction = CGC_DATA_READ; 16351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, cgc); 16361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 16371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_mode_select(struct pktcdvd_device *pd, struct packet_command *cgc) 16391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(cgc->cmd, 0, sizeof(cgc->cmd)); 16411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(cgc->buffer, 0, 2); 16421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[0] = GPCMD_MODE_SELECT_10; 16431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[1] = 0x10; /* PF */ 16441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[7] = cgc->buflen >> 8; 16451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[8] = cgc->buflen & 0xff; 16461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->data_direction = CGC_DATA_WRITE; 16471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, cgc); 16481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 16491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_get_disc_info(struct pktcdvd_device *pd, disc_information *di) 16511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 16531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 16541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* set up command and get the disc info */ 16561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, di, sizeof(*di), CGC_DATA_READ); 16571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_DISC_INFO; 16581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = cgc.buflen = 2; 16591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 16601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 16621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 16631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* not all drives have the same disc_info length, so requeue 16651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * packet with the length the drive tells us it can supply 16661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 16671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = be16_to_cpu(di->disc_information_length) + 16681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(di->disc_information_length); 16691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cgc.buflen > sizeof(disc_information)) 16711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = sizeof(disc_information); 16721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = cgc.buflen; 16741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 16751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 16761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_get_track_info(struct pktcdvd_device *pd, __u16 track, __u8 type, track_information *ti) 16781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 16801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 16811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, ti, 8, CGC_DATA_READ); 16831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_TRACK_RZONE_INFO; 16841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = type & 3; 16851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[4] = (track & 0xff00) >> 8; 16861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[5] = track & 0xff; 16871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = 8; 16881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 16891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 16911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 16921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = be16_to_cpu(ti->track_information_length) + 16941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(ti->track_information_length); 16951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cgc.buflen > sizeof(track_information)) 16971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = sizeof(track_information); 16981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = cgc.buflen; 17001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 17011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 170305680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_get_last_written(struct pktcdvd_device *pd, 170405680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlund long *last_written) 17051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 17061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disc_information di; 17071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds track_information ti; 17081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __u32 last_track; 17091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = -1; 17101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_disc_info(pd, &di))) 17121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last_track = (di.last_track_msb << 8) | di.last_track_lsb; 17151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_track_info(pd, last_track, 1, &ti))) 17161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* if this track is blank, try the previous. */ 17191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.blank) { 17201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last_track--; 17211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_track_info(pd, last_track, 1, &ti))) 17221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 17241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* if last recorded field is valid, return it. */ 17261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.lra_v) { 17271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *last_written = be32_to_cpu(ti.last_rec_address); 17281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 17291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* make it up instead */ 17301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *last_written = be32_to_cpu(ti.track_start) + 17311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds be32_to_cpu(ti.track_size); 17321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.free_blocks) 17331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *last_written -= (be32_to_cpu(ti.free_blocks) + 7); 17341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 17351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 17361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 17391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * write mode select package based on pd->settings 17401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 174105680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_set_write_settings(struct pktcdvd_device *pd) 17421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 17431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 17441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 17451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_param_page *wp; 17461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char buffer[128]; 17471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret, size; 17481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* doesn't apply to DVD+RW or DVD-RAM */ 17501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pd->mmc3_profile == 0x1a) || (pd->mmc3_profile == 0x12)) 17511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 17521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(buffer, 0, sizeof(buffer)); 17541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buffer, sizeof(*wp), CGC_DATA_READ); 17551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 17561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_sense(pd, &cgc, GPMODE_WRITE_PARMS_PAGE, 0))) { 17571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 17581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 17601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = 2 + ((buffer[0] << 8) | (buffer[1] & 0xff)); 17621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->mode_offset = (buffer[6] << 8) | (buffer[7] & 0xff); 17631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (size > sizeof(buffer)) 17641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = sizeof(buffer); 17651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 17671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * now get it all 17681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 17691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buffer, size, CGC_DATA_READ); 17701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 17711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_sense(pd, &cgc, GPMODE_WRITE_PARMS_PAGE, 0))) { 17721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 17731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 17751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 17771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * write page is offset header + block descriptor length 17781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 17791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp = (write_param_page *) &buffer[sizeof(struct mode_page_header) + pd->mode_offset]; 17801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->fp = pd->settings.fp; 17821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->track_mode = pd->settings.track_mode; 17831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->write_type = pd->settings.write_type; 17841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->data_block_type = pd->settings.block_mode; 17851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->multi_session = 0; 17871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef PACKET_USE_LS 17891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->link_size = 7; 17901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->ls_v = 1; 17911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 17921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (wp->data_block_type == PACKET_BLOCK_MODE1) { 17941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->session_format = 0; 17951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->subhdr2 = 0x20; 17961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (wp->data_block_type == PACKET_BLOCK_MODE2) { 17971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->session_format = 0x20; 17981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->subhdr2 = 8; 17991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 0 18001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->mcn[0] = 0x80; 18011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy(&wp->mcn[1], PACKET_MCN, sizeof(wp->mcn) - 1); 18021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 18031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 18041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 18051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * paranoia 18061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 18077822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": write mode wrong %d\n", wp->data_block_type); 18081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 18091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->packet_size = cpu_to_be32(pd->settings.size >> 2); 18111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = cgc.cmd[8] = size; 18131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_select(pd, &cgc))) { 18141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 18151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 18161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_print_settings(pd); 18191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 18201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 18211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 18237c613d593370292d1685f5794c743a2323be3a09Peter Osterlund * 1 -- we can write to this track, 0 -- we can't 18241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1825ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlundstatic int pkt_writable_track(struct pktcdvd_device *pd, track_information *ti) 18261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1827ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund switch (pd->mmc3_profile) { 1828ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund case 0x1a: /* DVD+RW */ 1829ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund case 0x12: /* DVD-RAM */ 1830ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund /* The track is always writable on DVD+RW/DVD-RAM */ 1831ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund return 1; 1832ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund default: 1833ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund break; 1834ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund } 18351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1836ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (!ti->packet || !ti->fp) 1837ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund return 0; 18381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 18401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * "good" settings as per Mt Fuji. 18411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1842ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (ti->rt == 0 && ti->blank == 0) 18437c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 18441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1845ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (ti->rt == 0 && ti->blank == 1) 18467c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 18471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1848ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (ti->rt == 1 && ti->blank == 0) 18497c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 18501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18517822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": bad state %d-%d-%d\n", ti->rt, ti->blank, ti->packet); 18527c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 18531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 18541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 18567c613d593370292d1685f5794c743a2323be3a09Peter Osterlund * 1 -- we can write to this disc, 0 -- we can't 18571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 18587c613d593370292d1685f5794c743a2323be3a09Peter Osterlundstatic int pkt_writable_disc(struct pktcdvd_device *pd, disc_information *di) 18591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 18601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (pd->mmc3_profile) { 18611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x0a: /* CD-RW */ 18621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0xffff: /* MMC3 not supported */ 18631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 18641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x1a: /* DVD+RW */ 18651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x13: /* DVD-RW */ 18661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x12: /* DVD-RAM */ 18677c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 18681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 18697822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": Wrong disc profile (%x)\n", pd->mmc3_profile); 18707c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 18711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 18741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * for disc type 0xff we should probably reserve a new track. 18751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * but i'm not sure, should we leave this to user apps? probably. 18761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 18771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->disc_type == 0xff) { 18787822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Unknown disc. No track?\n"); 18797c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 18801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->disc_type != 0x20 && di->disc_type != 0) { 18837822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Wrong disc type (%x)\n", di->disc_type); 18847c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 18851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->erasable == 0) { 18887822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Disc not erasable\n"); 18897c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 18901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->border_status == PACKET_SESSION_RESERVED) { 18937822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Can't write to last track (reserved)\n"); 18947c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 18951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18977c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 18981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 18991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 190005680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_probe_settings(struct pktcdvd_device *pd) 19011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 19021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 19031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[12]; 19041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disc_information di; 19051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds track_information ti; 19061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret, track; 19071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, sizeof(buf), CGC_DATA_READ); 19091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_GET_CONFIGURATION; 19101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = 8; 19111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_generic_packet(pd, &cgc); 19121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->mmc3_profile = ret ? 0xffff : buf[6] << 8 | buf[7]; 19131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&di, 0, sizeof(disc_information)); 19151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&ti, 0, sizeof(track_information)); 19161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_disc_info(pd, &di))) { 19181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk("failed get_disc\n"); 19191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 19201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19227c613d593370292d1685f5794c743a2323be3a09Peter Osterlund if (!pkt_writable_disc(pd, &di)) 19239db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 19241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->type = di.erasable ? PACKET_CDRW : PACKET_CDR; 19261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds track = 1; /* (di.last_track_msb << 8) | di.last_track_lsb; */ 19281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_track_info(pd, track, 1, &ti))) { 19297822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": failed get_track\n"); 19301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 19311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1933ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (!pkt_writable_track(pd, &ti)) { 19347822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": can't write to this track\n"); 19359db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 19361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 19391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * we keep packet size in 512 byte units, makes it easier to 19401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * deal with request calculations. 19411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 19421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.size = be32_to_cpu(ti.fixed_packet_size) << 2; 19431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->settings.size == 0) { 19447822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": detected zero packet size!\n"); 1945a460ad62260def15c42130de253d6cfc32528a2fPhillip Susi return -ENXIO; 19461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1947d0272e78eee4dc53c887fd132e9035daf037d423Peter Osterlund if (pd->settings.size > PACKET_MAX_SECTORS) { 19487822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": packet size is too big\n"); 19499db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 1950d0272e78eee4dc53c887fd132e9035daf037d423Peter Osterlund } 19511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.fp = ti.fp; 19521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->offset = (be32_to_cpu(ti.track_start) << 2) & (pd->settings.size - 1); 19531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.nwa_v) { 19551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->nwa = be32_to_cpu(ti.next_writable); 19561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_NWA_VALID, &pd->flags); 19571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 19601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * in theory we could use lra on -RW media as well and just zero 19611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * blocks that haven't been written yet, but in practice that 19621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is just a no-go. we'll use that for -R, naturally. 19631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 19641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.lra_v) { 19651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->lra = be32_to_cpu(ti.last_rec_address); 19661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_LRA_VALID, &pd->flags); 19671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 19681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->lra = 0xffffffff; 19691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_LRA_VALID, &pd->flags); 19701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 19731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * fine for now 19741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 19751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.link_loss = 7; 19761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.write_type = 0; /* packet */ 19771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.track_mode = ti.track_mode; 19781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 19801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * mode1 or mode2 disc 19811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 19821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (ti.data_mode) { 19831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_MODE1: 19841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.block_mode = PACKET_BLOCK_MODE1; 19851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 19861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_MODE2: 19871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.block_mode = PACKET_BLOCK_MODE2; 19881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 19891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 19907822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": unknown data mode\n"); 19919db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 19921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 19941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 19951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 19971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * enable/disable write caching on drive 19981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 199905680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_write_caching(struct pktcdvd_device *pd, 200005680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlund int set) 20011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 20021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 20031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 20041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[64]; 20051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 20061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, sizeof(buf), CGC_DATA_READ); 20081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 20091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = pd->mode_offset + 12; 20101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 20121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * caching mode page might not be there, so quiet this command 20131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 20141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 20151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_sense(pd, &cgc, GPMODE_WCACHING_PAGE, 0))) 20171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 20181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf[pd->mode_offset + 10] |= (!!set << 2); 20201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = cgc.cmd[8] = 2 + ((buf[0] << 8) | (buf[1] & 0xff)); 20221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_mode_select(pd, &cgc); 20231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 20247822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": write caching control failed\n"); 20251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 20261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (!ret && set) 20277822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": enabled write caching on %s\n", pd->name); 20281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 20291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 20301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_lock_door(struct pktcdvd_device *pd, int lockflag) 20321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 20331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 20341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 20361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL; 20371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[4] = lockflag ? 1 : 0; 20381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 20391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 20401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 20421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Returns drive maximum write speed 20431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 204405680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_get_max_speed(struct pktcdvd_device *pd, 204505680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlund unsigned *write_speed) 20461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 20471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 20481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 20491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[256+18]; 20501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char *cap_buf; 20511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret, offset; 20521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cap_buf = &buf[sizeof(struct mode_page_header) + pd->mode_offset]; 20541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, sizeof(buf), CGC_DATA_UNKNOWN); 20551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 20561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_mode_sense(pd, &cgc, GPMODE_CAPABILITIES_PAGE, 0); 20581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 20591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = pd->mode_offset + cap_buf[1] + 2 + 20601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(struct mode_page_header); 20611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_mode_sense(pd, &cgc, GPMODE_CAPABILITIES_PAGE, 0); 20621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 20631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 20641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 20651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = 20; /* Obsoleted field, used by older drives */ 20691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cap_buf[1] >= 28) 20701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = 28; /* Current write speed selected */ 20711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cap_buf[1] >= 30) { 20721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* If the drive reports at least one "Logical Unit Write 20731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Speed Performance Descriptor Block", use the information 20741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * in the first block. (contains the highest speed) 20751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 20761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int num_spdb = (cap_buf[30] << 8) + cap_buf[31]; 20771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (num_spdb > 0) 20781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = 34; 20791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *write_speed = (cap_buf[offset] << 8) | cap_buf[offset + 1]; 20821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 20831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 20841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* These tables from cdrecord - I don't have orange book */ 20861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* standard speed CD-RW (1-4x) */ 20871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic char clv_to_speed[16] = { 20881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */ 20891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0, 2, 4, 6, 8, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 20901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 20911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* high speed CD-RW (-10x) */ 20921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic char hs_clv_to_speed[16] = { 20931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */ 20941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0, 2, 4, 6, 10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 20951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 20961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* ultra high speed CD-RW */ 20971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic char us_clv_to_speed[16] = { 20981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */ 20991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0, 2, 4, 8, 0, 0,16, 0,24,32,40,48, 0, 0, 0, 0 21001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 21011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * reads the maximum media speed from ATIP 21041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 210505680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_media_speed(struct pktcdvd_device *pd, 210605680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlund unsigned *speed) 21071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 21081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 21091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 21101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[64]; 21111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int size, st, sp; 21121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 21131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, 2, CGC_DATA_READ); 21151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 21161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_TOC_PMA_ATIP; 21171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 2; 21181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[2] = 4; /* READ ATIP */ 21191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = 2; 21201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_generic_packet(pd, &cgc); 21211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 21221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 21231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 21241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = ((unsigned int) buf[0]<<8) + buf[1] + 2; 21261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (size > sizeof(buf)) 21271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = sizeof(buf); 21281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, size, CGC_DATA_READ); 21301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 21311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_TOC_PMA_ATIP; 21321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 2; 21331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[2] = 4; 21341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = size; 21351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_generic_packet(pd, &cgc); 21361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 21371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 21381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 21391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2141eaa0ff15c30dc9799eb4d12660edb73aeb6d32c5Alexey Dobriyan if (!(buf[6] & 0x40)) { 21427822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Disc type is not CD-RW\n"); 21431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 21441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2145eaa0ff15c30dc9799eb4d12660edb73aeb6d32c5Alexey Dobriyan if (!(buf[6] & 0x4)) { 21467822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": A1 values on media are not valid, maybe not CDRW?\n"); 21471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 21481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds st = (buf[6] >> 3) & 0x7; /* disc sub-type */ 21511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sp = buf[16] & 0xf; /* max speed from ATIP A1 field */ 21531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Info from cdrecord */ 21551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (st) { 21561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0: /* standard speed */ 21571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *speed = clv_to_speed[sp]; 21581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 21591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 1: /* high speed */ 21601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *speed = hs_clv_to_speed[sp]; 21611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 21621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 2: /* ultra high speed */ 21631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *speed = us_clv_to_speed[sp]; 21641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 21651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 21667822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Unknown disc sub-type %d\n",st); 21671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 21681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (*speed) { 21707822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Max. media speed: %d\n",*speed); 21711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 21721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 21737822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Unknown speed %d for sub-type %d\n",sp,st); 21741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 21751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 21771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 217805680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_perform_opc(struct pktcdvd_device *pd) 21791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 21801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 21811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 21821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 21831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21847822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": Performing OPC\n"); 21851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 21871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 21881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.timeout = 60*HZ; 21891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_SEND_OPC; 21901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 1; 21911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 21921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_dump_sense(&cgc); 21931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 21941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 21951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_open_write(struct pktcdvd_device *pd) 21971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 21981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 21991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int write_speed, media_write_speed, read_speed; 22001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_probe_settings(pd))) { 22027822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": %s failed probe\n", pd->name); 22039db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return ret; 22041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_set_write_settings(pd))) { 22077822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": %s failed saving write settings\n", pd->name); 22081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 22091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_write_caching(pd, USE_WCACHING); 22121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_max_speed(pd, &write_speed))) 22141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_speed = 16 * 177; 22151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (pd->mmc3_profile) { 22161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x13: /* DVD-RW */ 22171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x1a: /* DVD+RW */ 22181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x12: /* DVD-RAM */ 22197822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": write speed %ukB/s\n", write_speed); 22201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 22211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 22221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_media_speed(pd, &media_write_speed))) 22231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds media_write_speed = 16; 22241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_speed = min(write_speed, media_write_speed * 177); 22257822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": write speed %ux\n", write_speed / 176); 22261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 22271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_speed = write_speed; 22291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_set_speed(pd, write_speed, read_speed))) { 22317822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": %s couldn't set write speed\n", pd->name); 22321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 22331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->write_speed = write_speed; 22351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->read_speed = read_speed; 22361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_perform_opc(pd))) { 22387822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": %s Optimum Power Calibration failed\n", pd->name); 22391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 22421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 22431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 22451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * called at open time. 22461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2247aeb5d727062a0238a2f96c9c380fbd2be4640c6fAl Virostatic int pkt_open_dev(struct pktcdvd_device *pd, fmode_t write) 22481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 22491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 22501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds long lba; 2251165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboe struct request_queue *q; 22521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 22541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * We need to re-open the cdrom device without O_NONBLOCK to be able 22551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * to read/write from/to it. It is already opened in O_NONBLOCK mode 22561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * so bdget() can't fail. 22571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 22581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdget(pd->bdev->bd_dev); 2259e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo if ((ret = blkdev_get(pd->bdev, FMODE_READ | FMODE_EXCL, pd))) 22601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 22611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_last_written(pd, &lba))) { 22637822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": pkt_get_last_written failed\n"); 2264e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo goto out_putdev; 22651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_capacity(pd->disk, lba << 2); 22681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_capacity(pd->bdev->bd_disk, lba << 2); 22691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bd_set_size(pd->bdev, (loff_t)lba << 11); 22701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds q = bdev_get_queue(pd->bdev); 22721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (write) { 22731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_open_write(pd))) 2274e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo goto out_putdev; 22751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 22761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Some CDRW drives can not handle writes larger than one packet, 22771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * even if the size is a multiple of the packet size. 22781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 22791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(q->queue_lock); 2280086fa5ff0854c676ec333760f4c0154b3b242616Martin K. Petersen blk_queue_max_hw_sectors(q, pd->settings.size); 22811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(q->queue_lock); 22821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_WRITABLE, &pd->flags); 22831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 22841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, MAX_SPEED, MAX_SPEED); 22851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds clear_bit(PACKET_WRITABLE, &pd->flags); 22861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_set_segment_merging(pd, q))) 2289e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo goto out_putdev; 22901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2291e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund if (write) { 2292e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund if (!pkt_grow_pktlist(pd, CONFIG_CDROM_PKTCDVD_BUFFERS)) { 22937822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": not enough memory for buffers\n"); 2294e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund ret = -ENOMEM; 2295e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo goto out_putdev; 2296e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund } 22977822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": %lukB available on disc\n", lba << 1); 2298e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund } 22991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 23011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_putdev: 2303e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo blkdev_put(pd->bdev, FMODE_READ | FMODE_EXCL); 23041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 23051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 23061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 23071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 23091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * called when the device is closed. makes sure that the device flushes 23101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the internal cache before we close. 23111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 23121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_release_dev(struct pktcdvd_device *pd, int flush) 23131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 23141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (flush && pkt_flush_cache(pd)) 23157822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": %s not flushing cache\n", pd->name); 23161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_lock_door(pd, 0); 23181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, MAX_SPEED, MAX_SPEED); 2320e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo blkdev_put(pd->bdev, FMODE_READ | FMODE_EXCL); 2321e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund 2322e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund pkt_shrink_pktlist(pd); 23231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 23241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2325252a52aa4fa22a668f019e55b3aac3ff71ec1c29Dan Rosenbergstatic struct pktcdvd_device *pkt_find_dev_from_minor(unsigned int dev_minor) 23261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 23271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev_minor >= MAX_WRITERS) 23281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 23291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_devs[dev_minor]; 23301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 23311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23325e5e007c25009c304af693b7fc49bab8d1d25801Al Virostatic int pkt_open(struct block_device *bdev, fmode_t mode) 23331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 23341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = NULL; 23351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 23361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23377822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": entering open\n"); 23381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23392a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_lock(&pktcdvd_mutex); 23401657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_lock(&ctl_mutex); 23415e5e007c25009c304af693b7fc49bab8d1d25801Al Viro pd = pkt_find_dev_from_minor(MINOR(bdev->bd_dev)); 23421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd) { 23431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENODEV; 23441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 23451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->refcnt < 0); 23471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->refcnt++; 234946f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund if (pd->refcnt > 1) { 23505e5e007c25009c304af693b7fc49bab8d1d25801Al Viro if ((mode & FMODE_WRITE) && 235146f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund !test_bit(PACKET_WRITABLE, &pd->flags)) { 235246f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund ret = -EBUSY; 235346f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund goto out_dec; 235446f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund } 235546f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund } else { 23565e5e007c25009c304af693b7fc49bab8d1d25801Al Viro ret = pkt_open_dev(pd, mode & FMODE_WRITE); 235701fd9fda2ce462b44bafdac2fe6aacacf23531f2Peter Osterlund if (ret) 23581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_dec; 23591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 23601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * needed here as well, since ext2 (among others) may change 23611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the blocksize at mount time 23621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 23635e5e007c25009c304af693b7fc49bab8d1d25801Al Viro set_blocksize(bdev, CD_FRAMESIZE); 23641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23661657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_unlock(&ctl_mutex); 23672a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_unlock(&pktcdvd_mutex); 23681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 23691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_dec: 23711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->refcnt--; 23721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 23737822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": failed open (%d)\n", ret); 23741657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_unlock(&ctl_mutex); 23752a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_unlock(&pktcdvd_mutex); 23761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 23771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 23781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23795e5e007c25009c304af693b7fc49bab8d1d25801Al Virostatic int pkt_close(struct gendisk *disk, fmode_t mode) 23801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 23815e5e007c25009c304af693b7fc49bab8d1d25801Al Viro struct pktcdvd_device *pd = disk->private_data; 23821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = 0; 23831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23842a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_lock(&pktcdvd_mutex); 23851657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_lock(&ctl_mutex); 23861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->refcnt--; 23871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->refcnt < 0); 23881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->refcnt == 0) { 23891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int flush = test_bit(PACKET_WRITABLE, &pd->flags); 23901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_release_dev(pd, flush); 23911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23921657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_unlock(&ctl_mutex); 23932a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_unlock(&pktcdvd_mutex); 23941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 23951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 23961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23986712ecf8f648118c3363c142196418f89a510b90NeilBrownstatic void pkt_end_io_read_cloned(struct bio *bio, int err) 23991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 24001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_stacked_data *psd = bio->bi_private; 24011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = psd->pd; 24021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(bio); 24046712ecf8f648118c3363c142196418f89a510b90NeilBrown bio_endio(psd->bio, err); 24051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_free(psd, psd_pool); 24061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bio_finished(pd); 24071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 24081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24095a7bbad27a410350e64a2d7f5ec18fc73836c14fChristoph Hellwigstatic void pkt_make_request(struct request_queue *q, struct bio *bio) 24101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 24111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd; 24121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char b[BDEVNAME_SIZE]; 24131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t zone; 24141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 24151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int was_empty, blocked_bio; 24161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *node; 24171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd = q->queuedata; 24191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd) { 24207822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": %s incorrect request queue\n", bdevname(bio->bi_bdev, b)); 24211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto end_io; 24221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 24231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 24251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Clone READ bios so we can have our own bi_end_io callback. 24261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 24271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio_data_dir(bio) == READ) { 24281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *cloned_bio = bio_clone(bio, GFP_NOIO); 24291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_stacked_data *psd = mempool_alloc(psd_pool, GFP_NOIO); 24301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds psd->pd = pd; 24321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds psd->bio = bio; 24331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cloned_bio->bi_bdev = pd->bdev; 24341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cloned_bio->bi_private = psd; 24351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cloned_bio->bi_end_io = pkt_end_io_read_cloned; 24361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->stats.secs_r += bio->bi_size >> 9; 243746c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund pkt_queue_bio(pd, cloned_bio); 24385a7bbad27a410350e64a2d7f5ec18fc73836c14fChristoph Hellwig return; 24391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 24401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!test_bit(PACKET_WRITABLE, &pd->flags)) { 24427822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": WRITE for ro device %s (%llu)\n", 24431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->name, (unsigned long long)bio->bi_sector); 24441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto end_io; 24451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 24461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio->bi_size || (bio->bi_size % CD_FRAMESIZE)) { 24487822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": wrong bio size\n"); 24491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto end_io; 24501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 24511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_bounce(q, &bio); 24531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds zone = ZONE(bio->bi_sector, pd); 24551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds VPRINTK("pkt_make_request: start = %6llx stop = %6llx\n", 24561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (unsigned long long)bio->bi_sector, 2457f73a1c7d117d07a96d89475066188a2b79e53c48Kent Overstreet (unsigned long long)bio_end_sector(bio)); 24581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check if we have to split the bio */ 24601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 24611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio_pair *bp; 24621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t last_zone; 24631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int first_sectors; 24641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2465f73a1c7d117d07a96d89475066188a2b79e53c48Kent Overstreet last_zone = ZONE(bio_end_sector(bio) - 1, pd); 24661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (last_zone != zone) { 24671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(last_zone != zone + pd->settings.size); 24681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds first_sectors = last_zone - bio->bi_sector; 24696feef531f55cf4a20fd9eb39f5352e5745203603Denis ChengRq bp = bio_split(bio, first_sectors); 24701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!bp); 24711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_make_request(q, &bp->bio1); 24721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_make_request(q, &bp->bio2); 24731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_pair_release(bp); 24745a7bbad27a410350e64a2d7f5ec18fc73836c14fChristoph Hellwig return; 24751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 24761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 24771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 24791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * If we find a matching packet in state WAITING or READ_WAIT, we can 24801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * just append this bio to that packet. 24811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 24821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 24831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blocked_bio = 0; 24841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 24851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sector == zone) { 24861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 24871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pkt->state == PACKET_WAITING_STATE) || 24881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (pkt->state == PACKET_READ_WAIT_STATE)) { 2489c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_add(&pkt->orig_bios, bio); 24901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->write_size += bio->bi_size / CD_FRAMESIZE; 24911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pkt->write_size >= pkt->frames) && 24921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (pkt->state == PACKET_WAITING_STATE)) { 24931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 24941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 24951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 24961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 24971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 24985a7bbad27a410350e64a2d7f5ec18fc73836c14fChristoph Hellwig return; 24991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 25001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blocked_bio = 1; 25011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 25031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 25061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25070a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier /* 25080a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier * Test if there is enough room left in the bio work queue 25090a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier * (queue size >= congestion on mark). 25100a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier * If not, wait till the work queue size is below the congestion off mark. 25110a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier */ 25120a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_lock(&pd->lock); 25130a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier if (pd->write_congestion_on > 0 25140a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier && pd->bio_queue_size >= pd->write_congestion_on) { 25158aa7e847d834ed937a9ad37a0f2ad5b8584c1ab0Jens Axboe set_bdi_congested(&q->backing_dev_info, BLK_RW_ASYNC); 25160a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier do { 25170a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_unlock(&pd->lock); 25188aa7e847d834ed937a9ad37a0f2ad5b8584c1ab0Jens Axboe congestion_wait(BLK_RW_ASYNC, HZ); 25190a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_lock(&pd->lock); 25200a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier } while(pd->bio_queue_size > pd->write_congestion_off); 25210a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier } 25220a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_unlock(&pd->lock); 25230a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier 25241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 25251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * No matching packet found. Store the bio in the work queue. 25261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 25271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = mempool_alloc(pd->rb_pool, GFP_NOIO); 25281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node->bio = bio; 25291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->lock); 25301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->bio_queue_size < 0); 25311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds was_empty = (pd->bio_queue_size == 0); 25321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_rbtree_insert(pd, node); 25331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->lock); 25341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 25361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Wake up the worker thread. 25371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 25381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->scan_queue, 1); 25391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (was_empty) { 25401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This wake_up is required for correct operation */ 25411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 25421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (!list_empty(&pd->cdrw.pkt_free_list) && !blocked_bio) { 25431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 25441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This wake up is not required for correct operation, 25451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * but improves performance in some cases. 25461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 25471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 25481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 25495a7bbad27a410350e64a2d7f5ec18fc73836c14fChristoph Hellwig return; 25501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsend_io: 25516712ecf8f648118c3363c142196418f89a510b90NeilBrown bio_io_error(bio); 25521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 25531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2556cc371e66e340f35eed8dc4651c7c18e754c7fb26Alasdair G Kergonstatic int pkt_merge_bvec(struct request_queue *q, struct bvec_merge_data *bmd, 2557cc371e66e340f35eed8dc4651c7c18e754c7fb26Alasdair G Kergon struct bio_vec *bvec) 25581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 25591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = q->queuedata; 2560cc371e66e340f35eed8dc4651c7c18e754c7fb26Alasdair G Kergon sector_t zone = ZONE(bmd->bi_sector, pd); 2561cc371e66e340f35eed8dc4651c7c18e754c7fb26Alasdair G Kergon int used = ((bmd->bi_sector - zone) << 9) + bmd->bi_size; 25621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int remaining = (pd->settings.size << 9) - used; 25631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int remaining2; 25641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 25661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * A bio <= PAGE_SIZE must be allowed. If it crosses a packet 25671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * boundary, pkt_make_request() will split the bio. 25681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2569cc371e66e340f35eed8dc4651c7c18e754c7fb26Alasdair G Kergon remaining2 = PAGE_SIZE - bmd->bi_size; 25701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remaining = max(remaining, remaining2); 25711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(remaining < 0); 25731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return remaining; 25741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 25751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_init_queue(struct pktcdvd_device *pd) 25771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2578165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboe struct request_queue *q = pd->disk->queue; 25791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_make_request(q, pkt_make_request); 2581e1defc4ff0cf57aca6c5e3ff99fa503f5943c1f1Martin K. Petersen blk_queue_logical_block_size(q, CD_FRAMESIZE); 2582086fa5ff0854c676ec333760f4c0154b3b242616Martin K. Petersen blk_queue_max_hw_sectors(q, PACKET_MAX_SECTORS); 25831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_merge_bvec(q, pkt_merge_bvec); 25841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds q->queuedata = pd; 25851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 25861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_seq_show(struct seq_file *m, void *p) 25881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 25891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = m->private; 25901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char *msg; 25911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char bdev_buf[BDEVNAME_SIZE]; 25921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int states[PACKET_NUM_STATES]; 25931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "Writer %s mapped to %s:\n", pd->name, 25951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdevname(pd->bdev, bdev_buf)); 25961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nSettings:\n"); 25981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpacket size:\t\t%dkB\n", pd->settings.size / 2); 25991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->settings.write_type == 0) 26011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Packet"; 26021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 26031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Unknown"; 26041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\twrite type:\t\t%s\n", msg); 26051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpacket type:\t\t%s\n", pd->settings.fp ? "Fixed" : "Variable"); 26071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tlink loss:\t\t%d\n", pd->settings.link_loss); 26081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\ttrack mode:\t\t%d\n", pd->settings.track_mode); 26101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->settings.block_mode == PACKET_BLOCK_MODE1) 26121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Mode 1"; 26131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (pd->settings.block_mode == PACKET_BLOCK_MODE2) 26141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Mode 2"; 26151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 26161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Unknown"; 26171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tblock mode:\t\t%s\n", msg); 26181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nStatistics:\n"); 26201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpackets started:\t%lu\n", pd->stats.pkt_started); 26211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpackets ended:\t\t%lu\n", pd->stats.pkt_ended); 26221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\twritten:\t\t%lukB\n", pd->stats.secs_w >> 1); 26231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tread gather:\t\t%lukB\n", pd->stats.secs_rg >> 1); 26241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tread:\t\t\t%lukB\n", pd->stats.secs_r >> 1); 26251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nMisc:\n"); 26271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\treference count:\t%d\n", pd->refcnt); 26281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tflags:\t\t\t0x%lx\n", pd->flags); 26291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tread speed:\t\t%ukB/s\n", pd->read_speed); 26301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\twrite speed:\t\t%ukB/s\n", pd->write_speed); 26311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tstart offset:\t\t%lu\n", pd->offset); 26321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tmode page offset:\t%u\n", pd->mode_offset); 26331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nQueue state:\n"); 26351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tbios queued:\t\t%d\n", pd->bio_queue_size); 26361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tbios pending:\t\t%d\n", atomic_read(&pd->cdrw.pending_bios)); 26371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tcurrent sector:\t\t0x%llx\n", (unsigned long long)pd->current_sector); 26381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_count_states(pd, states); 26401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tstate:\t\t\ti:%d ow:%d rw:%d ww:%d rec:%d fin:%d\n", 26411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[0], states[1], states[2], states[3], states[4], states[5]); 26421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26430a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier seq_printf(m, "\twrite congestion marks:\toff=%d on=%d\n", 26440a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_off, 26450a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_on); 26461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 26471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 26481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_seq_open(struct inode *inode, struct file *file) 26501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 26511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return single_open(file, pkt_seq_show, PDE(inode)->data); 26521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 26531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26542b8693c0617e972fc0b2fd1ebf8de97e15b656c3Arjan van de Venstatic const struct file_operations pkt_proc_fops = { 26551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .open = pkt_seq_open, 26561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .read = seq_read, 26571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .llseek = seq_lseek, 26581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .release = single_release 26591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 26601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_new_dev(struct pktcdvd_device *pd, dev_t dev) 26621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 26631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 26641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = 0; 26651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char b[BDEVNAME_SIZE]; 26661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct block_device *bdev; 26671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->pkt_dev == dev) { 26697822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Recursive setup not allowed\n"); 26701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 26711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 26721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < MAX_WRITERS; i++) { 26731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd2 = pkt_devs[i]; 26741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd2) 26751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 26761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd2->bdev->bd_dev == dev) { 26777822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": %s already setup\n", bdevname(pd2->bdev, b)); 26781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 26791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 26801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd2->pkt_dev == dev) { 26817822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Can't chain pktcdvd devices\n"); 26821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 26831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 26841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 26851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdev = bdget(dev); 26871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bdev) 26881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 2689e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo ret = blkdev_get(bdev, FMODE_READ | FMODE_NDELAY, NULL); 26901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) 26911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 26921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This is safe, since we have a reference from open(). */ 26941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __module_get(THIS_MODULE); 26951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bdev = bdev; 26971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_blocksize(bdev, CD_FRAMESIZE); 26981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_init_queue(pd); 27001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->cdrw.pending_bios, 0); 27021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->cdrw.thread = kthread_run(kcdrwd, pd, "%s", pd->name); 27031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (IS_ERR(pd->cdrw.thread)) { 27047822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": can't start kernel thread\n"); 27051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENOMEM; 2706e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund goto out_mem; 27071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 27081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2709c7705f3449c7edd5c1744871097f93977227afc4Denis V. Lunev proc_create_data(pd->name, 0, pkt_proc, &pkt_proc_fops, pd); 27107822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": writer %s mapped to %s\n", pd->name, bdevname(bdev, b)); 27111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 27121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_mem: 27142cbed8906fd1f3c6cc17cdf8aac1bfad2da7960cAl Viro blkdev_put(bdev, FMODE_READ | FMODE_NDELAY); 27151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This is safe: open() is still holding a reference. */ 27161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds module_put(THIS_MODULE); 27171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 27181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 27191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27205e5e007c25009c304af693b7fc49bab8d1d25801Al Virostatic int pkt_ioctl(struct block_device *bdev, fmode_t mode, unsigned int cmd, unsigned long arg) 27211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 27225e5e007c25009c304af693b7fc49bab8d1d25801Al Viro struct pktcdvd_device *pd = bdev->bd_disk->private_data; 27238a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann int ret; 27241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27255e5e007c25009c304af693b7fc49bab8d1d25801Al Viro VPRINTK("pkt_ioctl: cmd %x, dev %d:%d\n", cmd, 27265e5e007c25009c304af693b7fc49bab8d1d25801Al Viro MAJOR(bdev->bd_dev), MINOR(bdev->bd_dev)); 27271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27282a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_lock(&pktcdvd_mutex); 27291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 2730a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro case CDROMEJECT: 2731a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro /* 2732a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro * The door gets locked when the device is opened, so we 2733a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro * have to unlock it or else the eject command fails. 2734a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro */ 2735a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro if (pd->refcnt == 1) 2736a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro pkt_lock_door(pd, 0); 2737a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro /* fallthru */ 27381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 27391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * forward selected CDROM ioctls to CD-ROM, for UDF 27401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 27411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROMMULTISESSION: 27421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROMREADTOCENTRY: 27431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROM_LAST_WRITTEN: 27441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROM_SEND_PACKET: 27451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case SCSI_IOCTL_SEND_COMMAND: 27468a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann ret = __blkdev_driver_ioctl(pd->bdev, mode, cmd, arg); 27478a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann break; 27481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 27507822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier VPRINTK(DRIVER_NAME": Unknown ioctl for %s (%x)\n", pd->name, cmd); 27518a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann ret = -ENOTTY; 27521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 27532a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_unlock(&pktcdvd_mutex); 27548560c650f340565b720fd57d1f9c99ab216d99d0Linus Torvalds 27558a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann return ret; 27561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 27571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27583c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heostatic unsigned int pkt_check_events(struct gendisk *disk, 27593c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo unsigned int clearing) 27601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 27611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = disk->private_data; 27621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct gendisk *attached_disk; 27631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd) 27651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 27661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd->bdev) 27671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 27681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds attached_disk = pd->bdev->bd_disk; 27693c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo if (!attached_disk || !attached_disk->fops->check_events) 27701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 27713c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo return attached_disk->fops->check_events(attached_disk, clearing); 27721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 27731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 277483d5cde47dedf01b6a4a4331882cbc0a7eea3c2eAlexey Dobriyanstatic const struct block_device_operations pktcdvd_ops = { 27751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 27765e5e007c25009c304af693b7fc49bab8d1d25801Al Viro .open = pkt_open, 27775e5e007c25009c304af693b7fc49bab8d1d25801Al Viro .release = pkt_close, 27788a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann .ioctl = pkt_ioctl, 27793c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo .check_events = pkt_check_events, 27801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 27811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27822c9ede55ecec58099b72e4bb8eab719f32f72c31Al Virostatic char *pktcdvd_devnode(struct gendisk *gd, umode_t *mode) 2783b03f38b685e2e1db174fb8982930e789a516f414Kay Sievers{ 2784b03f38b685e2e1db174fb8982930e789a516f414Kay Sievers return kasprintf(GFP_KERNEL, "pktcdvd/%s", gd->disk_name); 2785b03f38b685e2e1db174fb8982930e789a516f414Kay Sievers} 2786b03f38b685e2e1db174fb8982930e789a516f414Kay Sievers 27871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 27881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Set up mapping from pktcdvd device to CD-ROM device. 27891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2790adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierstatic int pkt_setup_dev(dev_t dev, dev_t* pkt_dev) 27911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 27921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int idx; 27931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = -ENOMEM; 27941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd; 27951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct gendisk *disk; 2796adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2797adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 27981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (idx = 0; idx < MAX_WRITERS; idx++) 28001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt_devs[idx]) 28011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 28021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (idx == MAX_WRITERS) { 28037822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": max %d writers supported\n", MAX_WRITERS); 2804adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = -EBUSY; 2805adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out_mutex; 28061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 28071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28081107d2e0352769b9bde6a4877c295b9309cdb877Peter Osterlund pd = kzalloc(sizeof(struct pktcdvd_device), GFP_KERNEL); 28091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd) 2810adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out_mutex; 28111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28120eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson pd->rb_pool = mempool_create_kmalloc_pool(PKT_RB_POOL_SIZE, 28130eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson sizeof(struct pkt_rb_node)); 28141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd->rb_pool) 28151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_mem; 28161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2817e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund INIT_LIST_HEAD(&pd->cdrw.pkt_free_list); 2818e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund INIT_LIST_HEAD(&pd->cdrw.pkt_active_list); 2819e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund spin_lock_init(&pd->cdrw.active_list_lock); 2820e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund 28211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_init(&pd->lock); 28221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_init(&pd->iosched.lock); 2823c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_init(&pd->iosched.read_queue); 2824c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_init(&pd->iosched.write_queue); 28257822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier sprintf(pd->name, DRIVER_NAME"%d", idx); 28261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_waitqueue_head(&pd->wqueue); 28271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bio_queue = RB_ROOT; 28281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28290a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_on = write_congestion_on; 28300a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_off = write_congestion_off; 28310a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier 2832adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier disk = alloc_disk(1); 2833adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier if (!disk) 2834adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out_mem; 2835adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier pd->disk = disk; 2836add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier disk->major = pktdev_major; 28371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->first_minor = idx; 28381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->fops = &pktcdvd_ops; 28391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->flags = GENHD_FL_REMOVABLE; 2840adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier strcpy(disk->disk_name, pd->name); 2841e454cea20bdcff10ee698d11b8882662a0153a47Kay Sievers disk->devnode = pktcdvd_devnode; 28421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->private_data = pd; 28431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->queue = blk_alloc_queue(GFP_KERNEL); 28441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!disk->queue) 28451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_mem2; 28461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2847f331c0296f2a9fee0d396a70598b954062603015Tejun Heo pd->pkt_dev = MKDEV(pktdev_major, idx); 28481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_new_dev(pd, dev); 28491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) 28501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_new_dev; 28511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28523c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo /* inherit events of the host device */ 28533c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo disk->events = pd->bdev->bd_disk->events; 28543c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo disk->async_events = pd->bdev->bd_disk->async_events; 28553c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo 28561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_disk(disk); 2857adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 285832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_dev_new(pd); 285932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_dev_new(pd); 286032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 28611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_devs[idx] = pd; 2862adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier if (pkt_dev) 2863adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier *pkt_dev = pd->pkt_dev; 2864adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2865adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 28661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 28671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_new_dev: 28691312f40e11c57edb5c3250f1b782cef8e3efea82Al Viro blk_cleanup_queue(disk->queue); 28701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_mem2: 28711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds put_disk(disk); 28721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_mem: 28731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->rb_pool) 28741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(pd->rb_pool); 28751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pd); 2876adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierout_mutex: 2877adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 2878adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier printk(DRIVER_NAME": setup of pktcdvd device failed\n"); 28791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 28801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 28811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 28831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Tear down mapping from pktcdvd device to CD-ROM device. 28841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2885adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierstatic int pkt_remove_dev(dev_t pkt_dev) 28861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 28871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd; 28881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int idx; 2889adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier int ret = 0; 2890adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2891adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 28921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (idx = 0; idx < MAX_WRITERS; idx++) { 28941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd = pkt_devs[idx]; 28951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd && (pd->pkt_dev == pkt_dev)) 28961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 28971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 28981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (idx == MAX_WRITERS) { 28997822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": dev not setup\n"); 2900adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = -ENXIO; 2901adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out; 29021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 29031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2904adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier if (pd->refcnt > 0) { 2905adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = -EBUSY; 2906adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out; 2907adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier } 29081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!IS_ERR(pd->cdrw.thread)) 29091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kthread_stop(pd->cdrw.thread); 29101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 291132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_devs[idx] = NULL; 291232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 291332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_dev_remove(pd); 291432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_dev_remove(pd); 291532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 29162cbed8906fd1f3c6cc17cdf8aac1bfad2da7960cAl Viro blkdev_put(pd->bdev, FMODE_READ | FMODE_NDELAY); 29171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remove_proc_entry(pd->name, pkt_proc); 29197822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier DPRINTK(DRIVER_NAME": writer %s unmapped\n", pd->name); 29201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds del_gendisk(pd->disk); 29221312f40e11c57edb5c3250f1b782cef8e3efea82Al Viro blk_cleanup_queue(pd->disk->queue); 29231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds put_disk(pd->disk); 29241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(pd->rb_pool); 29261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pd); 29271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This is safe: open() is still holding a reference. */ 29291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds module_put(THIS_MODULE); 2930adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2931adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierout: 2932adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 2933adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier return ret; 29341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 29351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_get_status(struct pkt_ctrl_command *ctrl_cmd) 29371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2938adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier struct pktcdvd_device *pd; 2939adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2940adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 2941adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2942adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier pd = pkt_find_dev_from_minor(ctrl_cmd->dev_index); 29431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd) { 29441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->dev = new_encode_dev(pd->bdev->bd_dev); 29451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->pkt_dev = new_encode_dev(pd->pkt_dev); 29461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 29471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->dev = 0; 29481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->pkt_dev = 0; 29491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 29501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->num_devices = MAX_WRITERS; 2951adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2952adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 29531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 29541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2955f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmannstatic long pkt_ctl_ioctl(struct file *file, unsigned int cmd, unsigned long arg) 29561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 29571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void __user *argp = (void __user *)arg; 29581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_ctrl_command ctrl_cmd; 29591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = 0; 2960adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier dev_t pkt_dev = 0; 29611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cmd != PACKET_CTRL_CMD) 29631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOTTY; 29641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_from_user(&ctrl_cmd, argp, sizeof(struct pkt_ctrl_command))) 29661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 29671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (ctrl_cmd.command) { 29691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PKT_CTRL_CMD_SETUP: 29701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!capable(CAP_SYS_ADMIN)) 29711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EPERM; 2972adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = pkt_setup_dev(new_decode_dev(ctrl_cmd.dev), &pkt_dev); 2973adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ctrl_cmd.pkt_dev = new_encode_dev(pkt_dev); 29741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 29751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PKT_CTRL_CMD_TEARDOWN: 29761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!capable(CAP_SYS_ADMIN)) 29771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EPERM; 2978adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = pkt_remove_dev(new_decode_dev(ctrl_cmd.pkt_dev)); 29791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 29801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PKT_CTRL_CMD_STATUS: 29811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_get_status(&ctrl_cmd); 29821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 29831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 29841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOTTY; 29851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 29861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_to_user(argp, &ctrl_cmd, sizeof(struct pkt_ctrl_command))) 29881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 29891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 29901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 29911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2992f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann#ifdef CONFIG_COMPAT 2993f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmannstatic long pkt_ctl_compat_ioctl(struct file *file, unsigned int cmd, unsigned long arg) 2994f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann{ 2995f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann return pkt_ctl_ioctl(file, cmd, (unsigned long)compat_ptr(arg)); 2996f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann} 2997f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann#endif 29981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29992b8693c0617e972fc0b2fd1ebf8de97e15b656c3Arjan van de Venstatic const struct file_operations pkt_ctl_fops = { 3000f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann .open = nonseekable_open, 3001f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann .unlocked_ioctl = pkt_ctl_ioctl, 3002f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann#ifdef CONFIG_COMPAT 3003f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann .compat_ioctl = pkt_ctl_compat_ioctl, 3004f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann#endif 3005f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann .owner = THIS_MODULE, 30066038f373a3dc1f1c26496e60b6c40b164716f07eArnd Bergmann .llseek = no_llseek, 30071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 30081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct miscdevice pkt_misc = { 30101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .minor = MISC_DYNAMIC_MINOR, 30117822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier .name = DRIVER_NAME, 3012e454cea20bdcff10ee698d11b8882662a0153a47Kay Sievers .nodename = "pktcdvd/control", 30131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .fops = &pkt_ctl_fops 30141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 30151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init pkt_init(void) 30171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 30181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 30191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 302032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier mutex_init(&ctl_mutex); 302132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 30220eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson psd_pool = mempool_create_kmalloc_pool(PSD_POOL_SIZE, 30230eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson sizeof(struct packet_stacked_data)); 30241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!psd_pool) 30251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 30261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3027add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier ret = register_blkdev(pktdev_major, DRIVER_NAME); 30281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret < 0) { 30297822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Unable to register block device\n"); 30301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out2; 30311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3032add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier if (!pktdev_major) 3033add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier pktdev_major = ret; 30341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 303532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier ret = pkt_sysfs_init(); 303632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (ret) 303732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier goto out; 303832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 303932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_init(); 304032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 30411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = misc_register(&pkt_misc); 30421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 30437822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier printk(DRIVER_NAME": Unable to register misc device\n"); 304432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier goto out_misc; 30451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 30461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3047928b4d8c8963e75bdb133f562b03b07f9aa4844aAlexey Dobriyan pkt_proc = proc_mkdir("driver/"DRIVER_NAME, NULL); 30481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 30501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 305132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierout_misc: 305232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_cleanup(); 305332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_cleanup(); 30541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 3055add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier unregister_blkdev(pktdev_major, DRIVER_NAME); 30561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout2: 30571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(psd_pool); 30581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 30591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 30601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit pkt_exit(void) 30621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3063928b4d8c8963e75bdb133f562b03b07f9aa4844aAlexey Dobriyan remove_proc_entry("driver/"DRIVER_NAME, NULL); 30641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds misc_deregister(&pkt_misc); 306532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 306632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_cleanup(); 306732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_cleanup(); 306832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 3069add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier unregister_blkdev(pktdev_major, DRIVER_NAME); 30701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(psd_pool); 30711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 30721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DESCRIPTION("Packet writing layer for CD/DVD drives"); 30741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Jens Axboe <axboe@suse.de>"); 30751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 30761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(pkt_init); 30781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(pkt_exit); 3079