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 4799481334bcab1330fce0c590b845b4a95b101a69Joe Perches#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 4899481334bcab1330fce0c590b845b4a95b101a69Joe Perches 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/pktcdvd.h> 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/types.h> 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kernel.h> 53f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann#include <linux/compat.h> 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kthread.h> 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/errno.h> 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/spinlock.h> 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/file.h> 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/proc_fs.h> 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/seq_file.h> 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/miscdevice.h> 617dfb71030f7636a0d65200158113c37764552f93Nigel Cunningham#include <linux/freezer.h> 621657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen#include <linux/mutex.h> 635a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <scsi/scsi_cmnd.h> 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <scsi/scsi_ioctl.h> 66cef289633a9321cd99dd5f6cc935657dc487e9f0Peter Osterlund#include <scsi/scsi.h> 6732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier#include <linux/debugfs.h> 6832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier#include <linux/device.h> 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/uaccess.h> 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 727822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier#define DRIVER_NAME "pktcdvd" 737822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier 74fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches#define pkt_err(pd, fmt, ...) \ 75fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pr_err("%s: " fmt, pd->name, ##__VA_ARGS__) 76ca73dabc3d1df4aaacb242b6d4e39cd36618444fJoe Perches#define pkt_notice(pd, fmt, ...) \ 77ca73dabc3d1df4aaacb242b6d4e39cd36618444fJoe Perches pr_notice("%s: " fmt, pd->name, ##__VA_ARGS__) 780c075d64df3aa9636a8700a710a2f2ada5e453a2Joe Perches#define pkt_info(pd, fmt, ...) \ 790c075d64df3aa9636a8700a710a2f2ada5e453a2Joe Perches pr_info("%s: " fmt, pd->name, ##__VA_ARGS__) 80fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches 81844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches#define pkt_dbg(level, pd, fmt, ...) \ 82844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perchesdo { \ 83844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches if (level == 2 && PACKET_DEBUG >= 2) \ 84844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pr_notice("%s: %s():" fmt, \ 85844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pd->name, __func__, ##__VA_ARGS__); \ 86844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches else if (level == 1 && PACKET_DEBUG >= 1) \ 87844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pr_notice("%s: " fmt, pd->name, ##__VA_ARGS__); \ 88cd3f2cd05cf1066f3975ed3223f12c799bc553c6Joe Perches} while (0) 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MAX_SPEED 0xffff 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 922a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmannstatic DEFINE_MUTEX(pktcdvd_mutex); 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct pktcdvd_device *pkt_devs[MAX_WRITERS]; 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct proc_dir_entry *pkt_proc; 95add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maierstatic int pktdev_major; 960a0fc9601dd1024ec7171993bf075a789246e1edThomas Maierstatic int write_congestion_on = PKT_WRITE_CONGESTION_ON; 970a0fc9601dd1024ec7171993bf075a789246e1edThomas Maierstatic int write_congestion_off = PKT_WRITE_CONGESTION_OFF; 981657f824e880a9bd239a3436b820d1a2986f763dJes Sorensenstatic struct mutex ctl_mutex; /* Serialize open/close/setup/teardown */ 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic mempool_t *psd_pool; 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct class *class_pktcdvd = NULL; /* /sys/class/pktcdvd */ 102ea5ffff57dce2f4c85ab056f4b0a202f71db2bdfGeunSik Limstatic struct dentry *pkt_debugfs_root = NULL; /* /sys/kernel/debug/pktcdvd */ 10332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 10432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* forward declaration */ 10532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_setup_dev(dev_t dev, dev_t* pkt_dev); 10632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_remove_dev(dev_t pkt_dev); 10732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_seq_show(struct seq_file *m, void *p); 10832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 1095323fb770b6254a4c218a2dfb0ef9aa007b7725aJoe Perchesstatic sector_t get_zone(sector_t sector, struct pktcdvd_device *pd) 1105323fb770b6254a4c218a2dfb0ef9aa007b7725aJoe Perches{ 1115323fb770b6254a4c218a2dfb0ef9aa007b7725aJoe Perches return (sector + pd->offset) & ~(sector_t)(pd->settings.size - 1); 1125323fb770b6254a4c218a2dfb0ef9aa007b7725aJoe Perches} 11332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 11432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* 11532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * create and register a pktcdvd kernel object. 11632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier */ 11732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct pktcdvd_kobj* pkt_kobj_create(struct pktcdvd_device *pd, 11832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier const char* name, 11932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct kobject* parent, 12032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct kobj_type* ktype) 12132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 12232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct pktcdvd_kobj *p; 12389c426066462263c90957c37af29765855516b83Greg Kroah-Hartman int error; 12489c426066462263c90957c37af29765855516b83Greg Kroah-Hartman 12532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier p = kzalloc(sizeof(*p), GFP_KERNEL); 12632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!p) 12732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return NULL; 12832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier p->pd = pd; 12989c426066462263c90957c37af29765855516b83Greg Kroah-Hartman error = kobject_init_and_add(&p->kobj, ktype, parent, "%s", name); 13089c426066462263c90957c37af29765855516b83Greg Kroah-Hartman if (error) { 131d17a18dd92c91c784fcf7c785fa6bbf178fd0a6dDave Young kobject_put(&p->kobj); 13232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return NULL; 133d17a18dd92c91c784fcf7c785fa6bbf178fd0a6dDave Young } 13489c426066462263c90957c37af29765855516b83Greg Kroah-Hartman kobject_uevent(&p->kobj, KOBJ_ADD); 13532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return p; 13632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 13732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* 13832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * remove a pktcdvd kernel object. 13932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier */ 14032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_kobj_remove(struct pktcdvd_kobj *p) 14132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 14232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (p) 143c10997f6575f476ff38442fa18fd4a0d80345f9dGreg Kroah-Hartman kobject_put(&p->kobj); 14432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 14532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* 14632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * default release function for pktcdvd kernel objects. 14732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier */ 14832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_kobj_release(struct kobject *kobj) 14932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 15032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier kfree(to_pktcdvdkobj(kobj)); 15132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 15232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 15332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 15432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/********************************************************** 15532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * 15632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * sysfs interface for pktcdvd 15732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * by (C) 2006 Thomas Maier <balagi@justmail.de> 15832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * 15932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier **********************************************************/ 16032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 16132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier#define DEF_ATTR(_obj,_name,_mode) \ 1627b595756ec1f49e0049a9e01a1298d53a7faaa15Tejun Heo static struct attribute _obj = { .name = _name, .mode = _mode } 16332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 16432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/********************************************************** 16532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier /sys/class/pktcdvd/pktcdvd[0-7]/ 16632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/reset 16732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/packets_started 16832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/packets_finished 16932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/kb_written 17032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/kb_read 17132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier stat/kb_read_gather 17232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier write_queue/size 17332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier write_queue/congestion_off 17432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier write_queue/congestion_on 17532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier **********************************************************/ 17632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 17732694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st1, "reset", 0200); 17832694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st2, "packets_started", 0444); 17932694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st3, "packets_finished", 0444); 18032694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st4, "kb_written", 0444); 18132694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st5, "kb_read", 0444); 18232694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_st6, "kb_read_gather", 0444); 18332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 18432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct attribute *kobj_pkt_attrs_stat[] = { 18532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st1, 18632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st2, 18732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st3, 18832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st4, 18932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st5, 19032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_st6, 19132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier NULL 19232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 19332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 19432694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_wq1, "size", 0444); 19532694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_wq2, "congestion_off", 0644); 19632694850a91bd4fedcdd4a46292f870588be81d1Thomas MaierDEF_ATTR(kobj_pkt_attr_wq3, "congestion_on", 0644); 19732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 19832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct attribute *kobj_pkt_attrs_wqueue[] = { 19932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_wq1, 20032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_wq2, 20132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_attr_wq3, 20232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier NULL 20332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 20432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 20532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic ssize_t kobj_pkt_show(struct kobject *kobj, 20632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct attribute *attr, char *data) 20732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 20832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct pktcdvd_device *pd = to_pktcdvdkobj(kobj)->pd; 20932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int n = 0; 21032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int v; 21132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (strcmp(attr->name, "packets_started") == 0) { 21232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.pkt_started); 21332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 21432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "packets_finished") == 0) { 21532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.pkt_ended); 21632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 21732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "kb_written") == 0) { 21832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.secs_w >> 1); 21932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 22032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "kb_read") == 0) { 22132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.secs_r >> 1); 22232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 22332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "kb_read_gather") == 0) { 22432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%lu\n", pd->stats.secs_rg >> 1); 22532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 22632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "size") == 0) { 22732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 22832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier v = pd->bio_queue_size; 22932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 23032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%d\n", v); 23132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 23232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_off") == 0) { 23332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 23432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier v = pd->write_congestion_off; 23532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 23632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%d\n", v); 23732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 23832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_on") == 0) { 23932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 24032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier v = pd->write_congestion_on; 24132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 24232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n = sprintf(data, "%d\n", v); 24332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 24432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return n; 24532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 24632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 24732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void init_write_congestion_marks(int* lo, int* hi) 24832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 24932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (*hi > 0) { 25032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *hi = max(*hi, 500); 25132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *hi = min(*hi, 1000000); 25232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (*lo <= 0) 25332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = *hi - 100; 25432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier else { 25532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = min(*lo, *hi - 100); 25632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = max(*lo, 100); 25732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 25832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else { 25932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *hi = -1; 26032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *lo = -1; 26132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 26232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 26332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 26432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic ssize_t kobj_pkt_store(struct kobject *kobj, 26532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct attribute *attr, 26632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier const char *data, size_t len) 26732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 26832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct pktcdvd_device *pd = to_pktcdvdkobj(kobj)->pd; 26932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int val; 27032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 27183f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier if (strcmp(attr->name, "reset") == 0 && len > 0) { 27232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.pkt_started = 0; 27332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.pkt_ended = 0; 27432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.secs_w = 0; 27532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.secs_rg = 0; 27632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->stats.secs_r = 0; 27732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 27832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_off") == 0 27983f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier && sscanf(data, "%d", &val) == 1) { 28032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 28132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->write_congestion_off = val; 28232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier init_write_congestion_marks(&pd->write_congestion_off, 28332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &pd->write_congestion_on); 28432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 28532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 28632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } else if (strcmp(attr->name, "congestion_on") == 0 28783f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier && sscanf(data, "%d", &val) == 1) { 28832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_lock(&pd->lock); 28932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->write_congestion_on = val; 29032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier init_write_congestion_marks(&pd->write_congestion_off, 29132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &pd->write_congestion_on); 29232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier spin_unlock(&pd->lock); 29332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 29432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return len; 29532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 29632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 29752cf25d0ab7f78eeecc59ac652ed5090f69b619eEmese Revfystatic const struct sysfs_ops kobj_pkt_ops = { 29832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .show = kobj_pkt_show, 29932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .store = kobj_pkt_store 30032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 30132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct kobj_type kobj_pkt_type_stat = { 30232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .release = pkt_kobj_release, 30332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .sysfs_ops = &kobj_pkt_ops, 30432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .default_attrs = kobj_pkt_attrs_stat 30532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 30632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct kobj_type kobj_pkt_type_wqueue = { 30732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .release = pkt_kobj_release, 30832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .sysfs_ops = &kobj_pkt_ops, 30932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .default_attrs = kobj_pkt_attrs_wqueue 31032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 31132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 31232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_sysfs_dev_new(struct pktcdvd_device *pd) 31332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 31432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (class_pktcdvd) { 315cba767175becadc5c4016cceb7bfdd2c7fe722f4Kay Sievers pd->dev = device_create(class_pktcdvd, NULL, MKDEV(0, 0), NULL, 3161ff9f542e5f87c299226557ce5e67a402ed4b502Greg Kroah-Hartman "%s", pd->name); 3176013c12be8313b3205b41912d965b03f3b06147dTony Jones if (IS_ERR(pd->dev)) 3186013c12be8313b3205b41912d965b03f3b06147dTony Jones pd->dev = NULL; 31932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 3206013c12be8313b3205b41912d965b03f3b06147dTony Jones if (pd->dev) { 32132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->kobj_stat = pkt_kobj_create(pd, "stat", 3226013c12be8313b3205b41912d965b03f3b06147dTony Jones &pd->dev->kobj, 32332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_type_stat); 32432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->kobj_wqueue = pkt_kobj_create(pd, "write_queue", 3256013c12be8313b3205b41912d965b03f3b06147dTony Jones &pd->dev->kobj, 32632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier &kobj_pkt_type_wqueue); 32732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 32832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 32932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 33032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_sysfs_dev_remove(struct pktcdvd_device *pd) 33132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 33232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_kobj_remove(pd->kobj_stat); 33332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_kobj_remove(pd->kobj_wqueue); 33432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (class_pktcdvd) 335ca0bf64d99f6e3f6e2fe2585e52a0ac57354beacThadeu Lima de Souza Cascardo device_unregister(pd->dev); 33632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 33732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 33832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 33932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/******************************************************************** 34032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier /sys/class/pktcdvd/ 34132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier add map block device 34232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier remove unmap packet dev 34332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier device_map show mappings 34432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *******************************************************************/ 34532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 34632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void class_pktcdvd_release(struct class *cls) 34732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 34832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier kfree(cls); 34932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 35028812fe11a21826ba4c97c6c7971a619987cd912Andi Kleenstatic ssize_t class_pktcdvd_show_map(struct class *c, 35128812fe11a21826ba4c97c6c7971a619987cd912Andi Kleen struct class_attribute *attr, 35228812fe11a21826ba4c97c6c7971a619987cd912Andi Kleen char *data) 35332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 35432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int n = 0; 35532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int idx; 35632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 35732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier for (idx = 0; idx < MAX_WRITERS; idx++) { 35832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier struct pktcdvd_device *pd = pkt_devs[idx]; 35932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!pd) 36032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier continue; 36132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier n += sprintf(data+n, "%s %u:%u %u:%u\n", 36232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->name, 36332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier MAJOR(pd->pkt_dev), MINOR(pd->pkt_dev), 36432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier MAJOR(pd->bdev->bd_dev), 36532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier MINOR(pd->bdev->bd_dev)); 36632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 36732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier mutex_unlock(&ctl_mutex); 36832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return n; 36932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 37032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 37128812fe11a21826ba4c97c6c7971a619987cd912Andi Kleenstatic ssize_t class_pktcdvd_store_add(struct class *c, 37228812fe11a21826ba4c97c6c7971a619987cd912Andi Kleen struct class_attribute *attr, 37328812fe11a21826ba4c97c6c7971a619987cd912Andi Kleen const char *buf, 37432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier size_t count) 37532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 37632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier unsigned int major, minor; 377fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo 37883f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier if (sscanf(buf, "%u:%u", &major, &minor) == 2) { 379fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo /* pkt_setup_dev() expects caller to hold reference to self */ 380fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo if (!try_module_get(THIS_MODULE)) 381fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo return -ENODEV; 382fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo 38332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_setup_dev(MKDEV(major, minor), NULL); 384fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo 385fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo module_put(THIS_MODULE); 386fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo 38732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return count; 38832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 389fffe487d59ba4017c7c62b06667ca4a226cee651Tejun Heo 39032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return -EINVAL; 39132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 39232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 39328812fe11a21826ba4c97c6c7971a619987cd912Andi Kleenstatic ssize_t class_pktcdvd_store_remove(struct class *c, 39428812fe11a21826ba4c97c6c7971a619987cd912Andi Kleen struct class_attribute *attr, 39528812fe11a21826ba4c97c6c7971a619987cd912Andi Kleen const char *buf, 39632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier size_t count) 39732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 39832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier unsigned int major, minor; 39983f3aa3dc5a5014cb4dc344e503b082344d8fe1eThomas Maier if (sscanf(buf, "%u:%u", &major, &minor) == 2) { 40032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_remove_dev(MKDEV(major, minor)); 40132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return count; 40232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 40332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return -EINVAL; 40432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 40532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 40632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic struct class_attribute class_pktcdvd_attrs[] = { 40732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR(add, 0200, NULL, class_pktcdvd_store_add), 40832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR(remove, 0200, NULL, class_pktcdvd_store_remove), 40932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR(device_map, 0444, class_pktcdvd_show_map, NULL), 41032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier __ATTR_NULL 41132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 41232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 41332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 41432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_sysfs_init(void) 41532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 41632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier int ret = 0; 41732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 41832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier /* 41932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * create control files in sysfs 42032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier * /sys/class/pktcdvd/... 42132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier */ 42232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd = kzalloc(sizeof(*class_pktcdvd), GFP_KERNEL); 42332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!class_pktcdvd) 42432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return -ENOMEM; 42532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->name = DRIVER_NAME; 42632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->owner = THIS_MODULE; 42732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->class_release = class_pktcdvd_release; 42832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd->class_attrs = class_pktcdvd_attrs; 42932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier ret = class_register(class_pktcdvd); 43032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (ret) { 43132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier kfree(class_pktcdvd); 43232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd = NULL; 43399481334bcab1330fce0c590b845b4a95b101a69Joe Perches pr_err("failed to create class pktcdvd\n"); 43432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return ret; 43532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier } 43632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return 0; 43732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 43832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 43932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_sysfs_cleanup(void) 44032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 44132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (class_pktcdvd) 44232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_destroy(class_pktcdvd); 44332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier class_pktcdvd = NULL; 44432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 44532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 44632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/******************************************************************** 44732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier entries in debugfs 44832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 449156f5a7801195fa2ce44aeeb62d6cf8468f3332aGeunSik Lim /sys/kernel/debug/pktcdvd[0-7]/ 45032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier info 45132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 45232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier *******************************************************************/ 45332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 45432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_debugfs_seq_show(struct seq_file *m, void *p) 45532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 45632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return pkt_seq_show(m, p); 45732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 45832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 45932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic int pkt_debugfs_fops_open(struct inode *inode, struct file *file) 46032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 46132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return single_open(file, pkt_debugfs_seq_show, inode->i_private); 46232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 46332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 4642b8693c0617e972fc0b2fd1ebf8de97e15b656c3Arjan van de Venstatic const struct file_operations debug_fops = { 46532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .open = pkt_debugfs_fops_open, 46632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .read = seq_read, 46732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .llseek = seq_lseek, 46832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .release = single_release, 46932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier .owner = THIS_MODULE, 47032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier}; 47132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 47232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_dev_new(struct pktcdvd_device *pd) 47332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 47432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!pkt_debugfs_root) 47532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 47632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_d_root = debugfs_create_dir(pd->name, pkt_debugfs_root); 47749c2856af779bb1a36fa598804e4c0b2251fae57Dan Carpenter if (!pd->dfs_d_root) 47832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 47949c2856af779bb1a36fa598804e4c0b2251fae57Dan Carpenter 48032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_f_info = debugfs_create_file("info", S_IRUGO, 48132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_d_root, pd, &debug_fops); 48232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 48332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 48432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_dev_remove(struct pktcdvd_device *pd) 48532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 48632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (!pkt_debugfs_root) 48732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier return; 48849c2856af779bb1a36fa598804e4c0b2251fae57Dan Carpenter debugfs_remove(pd->dfs_f_info); 48949c2856af779bb1a36fa598804e4c0b2251fae57Dan Carpenter debugfs_remove(pd->dfs_d_root); 49032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_f_info = NULL; 49132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pd->dfs_d_root = NULL; 49232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 49332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 49432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_init(void) 49532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 49632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_root = debugfs_create_dir(DRIVER_NAME, NULL); 49732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 49832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 49932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierstatic void pkt_debugfs_cleanup(void) 50032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier{ 50132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier debugfs_remove(pkt_debugfs_root); 50232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_root = NULL; 50332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier} 50432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 50532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier/* ----------------------------------------------------------*/ 50632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 5071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_bio_finished(struct pktcdvd_device *pd) 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(atomic_read(&pd->cdrw.pending_bios) <= 0); 5111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_dec_and_test(&pd->cdrw.pending_bios)) { 512844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "queue empty\n"); 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->iosched.attention, 1); 5141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Allocate a packet_data struct 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 521e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlundstatic struct packet_data *pkt_alloc_packet_data(int frames) 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 5241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5261107d2e0352769b9bde6a4877c295b9309cdb877Peter Osterlund pkt = kzalloc(sizeof(struct packet_data), GFP_KERNEL); 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt) 5281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_pkt; 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 530e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund pkt->frames = frames; 531ccc5c9ca6aac08218b1ba52afd07a1a9864c8c5dKent Overstreet pkt->w_bio = bio_kmalloc(GFP_KERNEL, frames); 5321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt->w_bio) 5331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_bio; 5341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 535e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames / FRAMES_PER_PAGE; i++) { 5361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->pages[i] = alloc_page(GFP_KERNEL|__GFP_ZERO); 5371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt->pages[i]) 5381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_page; 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_init(&pkt->lock); 542c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_init(&pkt->orig_bios); 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 544e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames; i++) { 545ccc5c9ca6aac08218b1ba52afd07a1a9864c8c5dKent Overstreet struct bio *bio = bio_kmalloc(GFP_KERNEL, 1); 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio) 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto no_rd_bio; 548ccc5c9ca6aac08218b1ba52afd07a1a9864c8c5dKent Overstreet 5491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->r_bios[i] = bio; 5501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt; 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_rd_bio: 555e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames; i++) { 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio = pkt->r_bios[i]; 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio) 5581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(bio); 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_page: 562e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < frames / FRAMES_PER_PAGE; i++) 5631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->pages[i]) 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __free_page(pkt->pages[i]); 5651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(pkt->w_bio); 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_bio: 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pkt); 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsno_pkt: 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 5731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Free a packet_data struct 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 5751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_free_packet_data(struct packet_data *pkt) 5761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 579e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < pkt->frames; i++) { 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio = pkt->r_bios[i]; 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio) 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(bio); 5831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 584e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund for (i = 0; i < pkt->frames / FRAMES_PER_PAGE; i++) 5851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __free_page(pkt->pages[i]); 5861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(pkt->w_bio); 5871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pkt); 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_shrink_pktlist(struct pktcdvd_device *pd) 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt, *next; 5931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!list_empty(&pd->cdrw.pkt_active_list)); 5951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry_safe(pkt, next, &pd->cdrw.pkt_free_list, list) { 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_free_packet_data(pkt); 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 599e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund INIT_LIST_HEAD(&pd->cdrw.pkt_free_list); 6001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_grow_pktlist(struct pktcdvd_device *pd, int nr_packets) 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 606e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund BUG_ON(!list_empty(&pd->cdrw.pkt_free_list)); 607e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund 6081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (nr_packets > 0) { 609e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund pkt = pkt_alloc_packet_data(pd->settings.size >> 2); 6101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt) { 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_shrink_pktlist(pd); 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 6131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->id = nr_packets; 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->pd = pd; 6161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add(&pkt->list, &pd->cdrw.pkt_free_list); 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds nr_packets--; 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 6201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline struct pkt_rb_node *pkt_rbtree_next(struct pkt_rb_node *node) 6231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *n = rb_next(&node->rb_node); 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!n) 6261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 6271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return rb_entry(n, struct pkt_rb_node, rb_node); 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 630ac893963030ad70e528dc23270d499d650546a38Peter Osterlundstatic void pkt_rbtree_erase(struct pktcdvd_device *pd, struct pkt_rb_node *node) 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rb_erase(&node->rb_node, &pd->bio_queue); 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_free(node, pd->rb_pool); 6341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bio_queue_size--; 6351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->bio_queue_size < 0); 6361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 6391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Find the first node in the pd->bio_queue rb tree with a starting sector >= s. 6401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 6411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct pkt_rb_node *pkt_rbtree_find(struct pktcdvd_device *pd, sector_t s) 6421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *n = pd->bio_queue.rb_node; 6441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *next; 6451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *tmp; 6461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!n) { 6481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->bio_queue_size > 0); 6491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 6501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 6531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = rb_entry(n, struct pkt_rb_node, rb_node); 6544f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet if (s <= tmp->bio->bi_iter.bi_sector) 6551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds next = n->rb_left; 6561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 6571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds next = n->rb_right; 6581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!next) 6591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 6601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds n = next; 6611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6634f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet if (s > tmp->bio->bi_iter.bi_sector) { 6641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = pkt_rbtree_next(tmp); 6651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!tmp) 6661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 6671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6684f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet BUG_ON(s > tmp->bio->bi_iter.bi_sector); 6691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return tmp; 6701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 6731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Insert a node into the pd->bio_queue rb tree. 6741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 6751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_rbtree_insert(struct pktcdvd_device *pd, struct pkt_rb_node *node) 6761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node **p = &pd->bio_queue.rb_node; 6781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *parent = NULL; 6794f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet sector_t s = node->bio->bi_iter.bi_sector; 6801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *tmp; 6811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (*p) { 6831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds parent = *p; 6841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds tmp = rb_entry(parent, struct pkt_rb_node, rb_node); 6854f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet if (s < tmp->bio->bi_iter.bi_sector) 6861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = &(*p)->rb_left; 6871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 6881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = &(*p)->rb_right; 6891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rb_link_node(&node->rb_node, parent, p); 6911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rb_insert_color(&node->rb_node, &pd->bio_queue); 6921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bio_queue_size++; 6931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 6961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Send a packet_command to the underlying block device and 6971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * wait for completion. 6981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 6991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_generic_packet(struct pktcdvd_device *pd, struct packet_command *cgc) 7001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 701165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboe struct request_queue *q = bdev_get_queue(pd->bdev); 7021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request *rq; 703406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig int ret = 0; 704406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig 705406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig rq = blk_get_request(q, (cgc->data_direction == CGC_DATA_WRITE) ? 706406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig WRITE : READ, __GFP_WAIT); 707a492f075450f3ba87de36e5ffe92a9d0c7af9723Joe Lawrence if (IS_ERR(rq)) 708a492f075450f3ba87de36e5ffe92a9d0c7af9723Joe Lawrence return PTR_ERR(rq); 709f27b087b81b70513b8c61ec20596c868f7b93474Jens Axboe blk_rq_set_block_pc(rq); 710406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig 711406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig if (cgc->buflen) { 7128586ea96b4f919a9b38929040bc9ce57c9998fc4Julia Lawall ret = blk_rq_map_kern(q, rq, cgc->buffer, cgc->buflen, 7138586ea96b4f919a9b38929040bc9ce57c9998fc4Julia Lawall __GFP_WAIT); 7148586ea96b4f919a9b38929040bc9ce57c9998fc4Julia Lawall if (ret) 715406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig goto out; 716406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig } 7171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 71891e4ee381d23ef67196a03924485aeceb32d6753Gerhard Dirschl rq->cmd_len = COMMAND_SIZE(cgc->cmd[0]); 719406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig memcpy(rq->cmd, cgc->cmd, CDROM_PACKET_SIZE); 7201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds rq->timeout = 60*HZ; 7221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cgc->quiet) 7234aff5e2333c9a1609662f2091f55c3f6fffdad36Jens Axboe rq->cmd_flags |= REQ_QUIET; 7241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 725406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig blk_execute_rq(rq->q, pd->bdev->bd_disk, rq, 0); 726cbc31a475a7f7748bd0a4e536533868e7cff8645Andrew Morton if (rq->errors) 727cbc31a475a7f7748bd0a4e536533868e7cff8645Andrew Morton ret = -EIO; 728406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwigout: 7291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_put_request(rq); 730406c9b605cbc45151c03ac9a3f95e9acf050808cChristoph Hellwig return ret; 7311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 73399481334bcab1330fce0c590b845b4a95b101a69Joe Perchesstatic const char *sense_key_string(__u8 index) 73499481334bcab1330fce0c590b845b4a95b101a69Joe Perches{ 73599481334bcab1330fce0c590b845b4a95b101a69Joe Perches static const char * const info[] = { 73699481334bcab1330fce0c590b845b4a95b101a69Joe Perches "No sense", "Recovered error", "Not ready", 73799481334bcab1330fce0c590b845b4a95b101a69Joe Perches "Medium error", "Hardware error", "Illegal request", 73899481334bcab1330fce0c590b845b4a95b101a69Joe Perches "Unit attention", "Data protect", "Blank check", 73999481334bcab1330fce0c590b845b4a95b101a69Joe Perches }; 74099481334bcab1330fce0c590b845b4a95b101a69Joe Perches 74199481334bcab1330fce0c590b845b4a95b101a69Joe Perches return index < ARRAY_SIZE(info) ? info[index] : "INVALID"; 74299481334bcab1330fce0c590b845b4a95b101a69Joe Perches} 74399481334bcab1330fce0c590b845b4a95b101a69Joe Perches 7441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * A generic sense dump / resolve mechanism should be implemented across 7461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * all ATAPI + SCSI devices. 7471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 748f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perchesstatic void pkt_dump_sense(struct pktcdvd_device *pd, 749f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perches struct packet_command *cgc) 7501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense *sense = cgc->sense; 7521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 75399481334bcab1330fce0c590b845b4a95b101a69Joe Perches if (sense) 754f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perches pkt_err(pd, "%*ph - sense %02x.%02x.%02x (%s)\n", 755f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perches CDROM_PACKET_SIZE, cgc->cmd, 756f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perches sense->sense_key, sense->asc, sense->ascq, 757f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perches sense_key_string(sense->sense_key)); 75899481334bcab1330fce0c590b845b4a95b101a69Joe Perches else 759f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perches pkt_err(pd, "%*ph - no sense\n", CDROM_PACKET_SIZE, cgc->cmd); 7601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * flush the drive cache to media 7641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_flush_cache(struct pktcdvd_device *pd) 7661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 7681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 7701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_FLUSH_CACHE; 7711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 7721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 7741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the IMMED bit -- we default to not setting it, although that 7751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * would allow a much faster close, this is safer 7761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 0 7781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 1 << 1; 7791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 7801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 7811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 7821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 7841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * speed is given as the normal factor, e.g. 4 for 4x 7851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 78605680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_set_speed(struct pktcdvd_device *pd, 78705680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlund unsigned write_speed, unsigned read_speed) 7881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 7891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 7901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 7911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 7921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 7931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 7941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 7951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_SET_SPEED; 7961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[2] = (read_speed >> 8) & 0xff; 7971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[3] = read_speed & 0xff; 7981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[4] = (write_speed >> 8) & 0xff; 7991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[5] = write_speed & 0xff; 8001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 802f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perches pkt_dump_sense(pd, &cgc); 8031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 8051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 8081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Queue a bio for processing by the low-level CD device. Must be called 8091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * from process context. 8101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 81146c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlundstatic void pkt_queue_bio(struct pktcdvd_device *pd, struct bio *bio) 8121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->iosched.lock); 814c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita if (bio_data_dir(bio) == READ) 815c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_add(&pd->iosched.read_queue, bio); 816c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita else 817c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_add(&pd->iosched.write_queue, bio); 8181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->iosched.lock); 8191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->iosched.attention, 1); 8211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 8221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 8251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Process the queued read/write requests. This function handles special 8261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * requirements for CDRW drives: 8271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * - A cache flush command must be inserted before a read request if the 8281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * previous request was a write. 82946c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * - Switching between reading and writing is slow, so don't do it more often 8301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * than necessary. 83146c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * - Optimize for throughput at the expense of latency. This means that streaming 83246c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * writes will never be interrupted by a read, but if the drive has to seek 83346c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * before the next write, switch to reading instead if there are any pending 83446c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund * read requests. 8351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * - Set the read speed according to current usage pattern. When only reading 8361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * from the device, it's best to use the highest possible read speed, but 8371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * when switching often between reading and writing, it's better to have the 8381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * same read and write speeds. 8391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 8401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_iosched_process_queue(struct pktcdvd_device *pd) 8411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->iosched.attention) == 0) 8441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 8451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->iosched.attention, 0); 8461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 8481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio; 84946c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund int reads_queued, writes_queued; 8501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->iosched.lock); 852c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita reads_queued = !bio_list_empty(&pd->iosched.read_queue); 853c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita writes_queued = !bio_list_empty(&pd->iosched.write_queue); 8541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->iosched.lock); 8551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!reads_queued && !writes_queued) 8571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 8581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->iosched.writing) { 86046c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund int need_write_seek = 1; 86146c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund spin_lock(&pd->iosched.lock); 862c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio = bio_list_peek(&pd->iosched.write_queue); 86346c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund spin_unlock(&pd->iosched.lock); 8644f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet if (bio && (bio->bi_iter.bi_sector == 8654f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet pd->iosched.last_write)) 86646c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund need_write_seek = 0; 86746c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund if (need_write_seek && reads_queued) { 8681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->cdrw.pending_bios) > 0) { 869844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "write, waiting\n"); 8701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 8711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_flush_cache(pd); 8731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->iosched.writing = 0; 8741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 8761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!reads_queued && writes_queued) { 8771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->cdrw.pending_bios) > 0) { 878844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "read, waiting\n"); 8791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 8801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->iosched.writing = 1; 8821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->iosched.lock); 886c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita if (pd->iosched.writing) 887c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio = bio_list_pop(&pd->iosched.write_queue); 888c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita else 889c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio = bio_list_pop(&pd->iosched.read_queue); 8901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->iosched.lock); 8911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio) 8931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 8941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bio_data_dir(bio) == READ) 8964f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet pd->iosched.successive_reads += 8974f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet bio->bi_iter.bi_size >> 10; 89846c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund else { 8991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->iosched.successive_reads = 0; 900f73a1c7d117d07a96d89475066188a2b79e53c48Kent Overstreet pd->iosched.last_write = bio_end_sector(bio); 90146c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund } 9021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->iosched.successive_reads >= HI_SPEED_SWITCH) { 9031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->read_speed == pd->write_speed) { 9041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->read_speed = MAX_SPEED; 9051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, pd->write_speed, pd->read_speed); 9061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 9081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->read_speed != pd->write_speed) { 9091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->read_speed = pd->write_speed; 9101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, pd->write_speed, pd->read_speed); 9111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pd->cdrw.pending_bios); 9151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds generic_make_request(bio); 9161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 9201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Special care is needed if the underlying block device has a small 9211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * max_phys_segments value. 9221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 923165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboestatic int pkt_set_segment_merging(struct pktcdvd_device *pd, struct request_queue *q) 9241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 925ae03bf639a5027d27270123f5f6e3ee6a412781dMartin K. Petersen if ((pd->settings.size << 9) / CD_FRAMESIZE 9268a78362c4eefc1deddbefe2c7f38aabbc2429d6bMartin K. Petersen <= queue_max_segments(q)) { 9271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 9281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * The cdrom device can handle one segment/frame 9291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds clear_bit(PACKET_MERGE_SEGS, &pd->flags); 9311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 932ae03bf639a5027d27270123f5f6e3ee6a412781dMartin K. Petersen } else if ((pd->settings.size << 9) / PAGE_SIZE 9338a78362c4eefc1deddbefe2c7f38aabbc2429d6bMartin K. Petersen <= queue_max_segments(q)) { 9341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 9351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * We can handle this case at the expense of some extra memory 9361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * copies during write operations 9371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_MERGE_SEGS, &pd->flags); 9391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 9401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 941fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "cdrom max_phys_segments too small\n"); 9421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 9431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 9471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copy all data for this packet to pkt->pages[], so that 9481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * a) The number of required segments for the write bio is minimized, which 9491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is necessary for some scsi controllers. 9501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * b) The data can be used as cache to avoid read requests if we receive a 9511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * new write request for the same zone. 9521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 9537277232374680595cdbc774fd246b206f56db015Peter Osterlundstatic void pkt_make_local_copy(struct packet_data *pkt, struct bio_vec *bvec) 9541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int f, p, offs; 9561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Copy all data to pkt->pages[] */ 9581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = 0; 9591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offs = 0; 9601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = 0; f < pkt->frames; f++) { 9617277232374680595cdbc774fd246b206f56db015Peter Osterlund if (bvec[f].bv_page != pkt->pages[p]) { 962cfd8005c99c68882e962807d36603791adddfb9fCong Wang void *vfrom = kmap_atomic(bvec[f].bv_page) + bvec[f].bv_offset; 9631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void *vto = page_address(pkt->pages[p]) + offs; 9641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy(vto, vfrom, CD_FRAMESIZE); 965cfd8005c99c68882e962807d36603791adddfb9fCong Wang kunmap_atomic(vfrom); 9667277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_page = pkt->pages[p]; 9677277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_offset = offs; 9681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 9697277232374680595cdbc774fd246b206f56db015Peter Osterlund BUG_ON(bvec[f].bv_offset != offs); 9701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offs += CD_FRAMESIZE; 9721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (offs >= PAGE_SIZE) { 9731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offs = 0; 9741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p++; 9751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9796712ecf8f648118c3363c142196418f89a510b90NeilBrownstatic void pkt_end_io_read(struct bio *bio, int err) 9801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 9811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt = bio->bi_private; 9821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = pkt->pd; 9831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!pd); 9841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 985844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "bio=%p sec0=%llx sec=%llx err=%d\n", 986cd3f2cd05cf1066f3975ed3223f12c799bc553c6Joe Perches bio, (unsigned long long)pkt->sector, 9874f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet (unsigned long long)bio->bi_iter.bi_sector, err); 9881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err) 9901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->io_errors); 9911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_dec_and_test(&pkt->io_wait)) { 9921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 9931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 9941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bio_finished(pd); 9961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9986712ecf8f648118c3363c142196418f89a510b90NeilBrownstatic void pkt_end_io_packet_write(struct bio *bio, int err) 9991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt = bio->bi_private; 10011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = pkt->pd; 10021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(!pd); 10031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1004844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "id=%d, err=%d\n", pkt->id, err); 10051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->stats.pkt_ended++; 10071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bio_finished(pd); 10091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_dec(&pkt->io_wait); 10101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 10111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 10121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 10151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Schedule reads for the holes in a packet 10161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 10171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_gather_data(struct pktcdvd_device *pd, struct packet_data *pkt) 10181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int frames_read = 0; 10201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio; 10211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int f; 10221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char written[PACKET_MAX_SIZE]; 10231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1024c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita BUG_ON(bio_list_empty(&pkt->orig_bios)); 10251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->io_wait, 0); 10271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->io_errors, 0); 10281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 10301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Figure out which frames we need to read before we can write. 10311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 10321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(written, 0, sizeof(written)); 10331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 1034c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_for_each(bio, &pkt->orig_bios) { 10354f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet int first_frame = (bio->bi_iter.bi_sector - pkt->sector) / 10364f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet (CD_FRAMESIZE >> 9); 10374f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet int num_frames = bio->bi_iter.bi_size / CD_FRAMESIZE; 103806e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund pd->stats.secs_w += num_frames * (CD_FRAMESIZE >> 9); 10391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(first_frame < 0); 10401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(first_frame + num_frames > pkt->frames); 10411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = first_frame; f < first_frame + num_frames; f++) 10421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds written[f] = 1; 10431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 10451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 104606e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund if (pkt->cache_valid) { 1047844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "zone %llx cached\n", 104806e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund (unsigned long long)pkt->sector); 104906e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund goto out_account; 105006e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund } 105106e7ab53f4a1e8bbf66c3985968468949d74d006Peter Osterlund 10521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 10531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Schedule reads for missing parts of the packet. 10541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 10551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = 0; f < pkt->frames; f++) { 10561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int p, offset; 1057ccc5c9ca6aac08218b1ba52afd07a1a9864c8c5dKent Overstreet 10581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (written[f]) 10591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 1060ccc5c9ca6aac08218b1ba52afd07a1a9864c8c5dKent Overstreet 10611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = pkt->r_bios[f]; 1062ccc5c9ca6aac08218b1ba52afd07a1a9864c8c5dKent Overstreet bio_reset(bio); 10634f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet bio->bi_iter.bi_sector = pkt->sector + f * (CD_FRAMESIZE >> 9); 10641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_bdev = pd->bdev; 10651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_end_io = pkt_end_io_read; 10661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_private = pkt; 10671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = (f * CD_FRAMESIZE) / PAGE_SIZE; 10691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = (f * CD_FRAMESIZE) % PAGE_SIZE; 1070844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "Adding frame %d, page:%p offs:%d\n", 10711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds f, pkt->pages[p], offset); 10721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio_add_page(bio, pkt->pages[p], CD_FRAMESIZE, offset)) 10731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG(); 10741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->io_wait); 10761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio->bi_rw = READ; 107746c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund pkt_queue_bio(pd, bio); 10781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_read++; 10791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_account: 1082844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "need %d frames for zone %llx\n", 10831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds frames_read, (unsigned long long)pkt->sector); 10841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->stats.pkt_started++; 10851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->stats.secs_rg += frames_read * (CD_FRAMESIZE >> 9); 10861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 10891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Find a packet matching zone, or the least recently used packet if 10901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * there is no match. 10911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 10921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct packet_data *pkt_get_packet_data(struct pktcdvd_device *pd, int zone) 10931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 10951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_free_list, list) { 10971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sector == zone || pkt->list.next == &pd->cdrw.pkt_free_list) { 10981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_del_init(&pkt->list); 10991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sector != zone) 11001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 0; 1101610827dee82731c7be5a135d750d194ac56881a9Peter Osterlund return pkt; 11021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1104610827dee82731c7be5a135d750d194ac56881a9Peter Osterlund BUG(); 1105610827dee82731c7be5a135d750d194ac56881a9Peter Osterlund return NULL; 11061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_put_packet_data(struct pktcdvd_device *pd, struct packet_data *pkt) 11091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->cache_valid) { 11111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add(&pkt->list, &pd->cdrw.pkt_free_list); 11121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 11131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add_tail(&pkt->list, &pd->cdrw.pkt_free_list); 11141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 11181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * recover a failed write, query for relocation if possible 11191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 11201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * returns 1 if recovery is possible, or 0 if not 11211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 11221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 11231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_start_recovery(struct packet_data *pkt) 11241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 11261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * FIXME. We need help from the file system to implement 11271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * recovery handling. 11281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 11291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 11301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 0 11311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request *rq = pkt->rq; 11321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = rq->rq_disk->private_data; 11331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct block_device *pkt_bdev; 11341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct super_block *sb = NULL; 11351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long old_block, new_block; 11361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t new_sector; 11371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bdev = bdget(kdev_t_to_nr(pd->pkt_dev)); 11391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt_bdev) { 11401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sb = get_super(pkt_bdev); 11411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdput(pkt_bdev); 11421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!sb) 11451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 11461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1147e7f59097071f2e193e900093742a4be85839f3d9Al Viro if (!sb->s_op->relocate_blocks) 11481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 11491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds old_block = pkt->sector / (CD_FRAMESIZE >> 9); 11511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sb->s_op->relocate_blocks(sb, old_block, &new_block)) 11521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 11531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds new_sector = new_block * (CD_FRAMESIZE >> 9); 11551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sector = new_sector; 11561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1157ff8e0070d1a4d09cb462d3059956530fa67fd91dKent Overstreet bio_reset(pkt->bio); 1158ff8e0070d1a4d09cb462d3059956530fa67fd91dKent Overstreet pkt->bio->bi_bdev = pd->bdev; 1159ff8e0070d1a4d09cb462d3059956530fa67fd91dKent Overstreet pkt->bio->bi_rw = REQ_WRITE; 11604f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet pkt->bio->bi_iter.bi_sector = new_sector; 11614f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet pkt->bio->bi_iter.bi_size = pkt->frames * CD_FRAMESIZE; 1162ff8e0070d1a4d09cb462d3059956530fa67fd91dKent Overstreet pkt->bio->bi_vcnt = pkt->frames; 11631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1164ff8e0070d1a4d09cb462d3059956530fa67fd91dKent Overstreet pkt->bio->bi_end_io = pkt_end_io_packet_write; 1165ff8e0070d1a4d09cb462d3059956530fa67fd91dKent Overstreet pkt->bio->bi_private = pkt; 11661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds drop_super(sb); 11681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 11691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 11711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds drop_super(sb); 11721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 11731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 11741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void pkt_set_state(struct packet_data *pkt, enum packet_data_state state) 11771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if PACKET_DEBUG > 1 11791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds static const char *state_name[] = { 11801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds "IDLE", "WAITING", "READ_WAIT", "WRITE_WAIT", "RECOVERY", "FINISHED" 11811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds }; 11821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds enum packet_data_state old_state = pkt->state; 1183844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "pkt %2d : s=%6llx %s -> %s\n", 1184cd3f2cd05cf1066f3975ed3223f12c799bc553c6Joe Perches pkt->id, (unsigned long long)pkt->sector, 11851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds state_name[old_state], state_name[state]); 11861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 11871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->state = state; 11881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 11891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 11911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Scan the work queue to see if we can start a new packet. 11921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * returns non-zero if any work was done. 11931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 11941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_handle_queue(struct pktcdvd_device *pd) 11951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 11961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt, *p; 11971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bio *bio = NULL; 11981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t zone = 0; /* Suppress gcc warning */ 11991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *node, *first_node; 12001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct rb_node *n; 12010a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier int wakeup; 12021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->scan_queue, 0); 12041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (list_empty(&pd->cdrw.pkt_free_list)) { 1206844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "no pkt\n"); 12071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 12081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 12111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Try to find a zone we are not already working on. 12121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 12131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->lock); 12141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds first_node = pkt_rbtree_find(pd, pd->current_sector); 12151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!first_node) { 12161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds n = rb_first(&pd->bio_queue); 12171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (n) 12181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds first_node = rb_entry(n, struct pkt_rb_node, rb_node); 12191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = first_node; 12211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (node) { 12221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = node->bio; 12234f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet zone = get_zone(bio->bi_iter.bi_sector, pd); 12241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(p, &pd->cdrw.pkt_active_list, list) { 12257baeb6a5ccab2d472679a053e64a63ac423c3a42Peter Osterlund if (p->sector == zone) { 12267baeb6a5ccab2d472679a053e64a63ac423c3a42Peter Osterlund bio = NULL; 12271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto try_next_bio; 12287baeb6a5ccab2d472679a053e64a63ac423c3a42Peter Osterlund } 12291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 12311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldstry_next_bio: 12321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = pkt_rbtree_next(node); 12331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!node) { 12341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds n = rb_first(&pd->bio_queue); 12351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (n) 12361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = rb_entry(n, struct pkt_rb_node, rb_node); 12371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (node == first_node) 12391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = NULL; 12401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->lock); 12421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bio) { 1243844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "no bio\n"); 12441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 12451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt = pkt_get_packet_data(pd, zone); 12481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->current_sector = zone + pd->settings.size; 12501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sector = zone; 1251e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund BUG_ON(pkt->frames != pd->settings.size >> 2); 12521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->write_size = 0; 12531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 12551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Scan work queue for bios in the same zone and link them 12561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * to this packet. 12571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 12581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->lock); 1259844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "looking for zone %llx\n", (unsigned long long)zone); 12601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while ((node = pkt_rbtree_find(pd, zone)) != NULL) { 12611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio = node->bio; 12624f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet pkt_dbg(2, pd, "found zone=%llx\n", (unsigned long long) 12634f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet get_zone(bio->bi_iter.bi_sector, pd)); 12644f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet if (get_zone(bio->bi_iter.bi_sector, pd) != zone) 12651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 12661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_rbtree_erase(pd, node); 12671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 1268c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_add(&pkt->orig_bios, bio); 12694f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet pkt->write_size += bio->bi_iter.bi_size / CD_FRAMESIZE; 12701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 12711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 12720a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier /* check write congestion marks, and if bio_queue_size is 12730a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier below, wake up any waiters */ 12740a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier wakeup = (pd->write_congestion_on > 0 12750a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier && pd->bio_queue_size <= pd->write_congestion_off); 12761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->lock); 12778aa7e847d834ed937a9ad37a0f2ad5b8584c1ab0Jens Axboe if (wakeup) { 12788aa7e847d834ed937a9ad37a0f2ad5b8584c1ab0Jens Axboe clear_bdi_congested(&pd->disk->queue->backing_dev_info, 12798aa7e847d834ed937a9ad37a0f2ad5b8584c1ab0Jens Axboe BLK_RW_ASYNC); 12808aa7e847d834ed937a9ad37a0f2ad5b8584c1ab0Jens Axboe } 12811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time = max(PACKET_WAIT_TIME, 1); 12831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_WAITING_STATE); 12841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->run_sm, 1); 12851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 12871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_add(&pkt->list, &pd->cdrw.pkt_active_list); 12881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 12891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 12911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 12921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 12941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Assemble a bio to write one packet and queue the bio for processing 12951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * by the underlying block device. 12961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 12971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_start_write(struct pktcdvd_device *pd, struct packet_data *pkt) 12981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 12991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int f; 13007277232374680595cdbc774fd246b206f56db015Peter Osterlund struct bio_vec *bvec = pkt->w_bio->bi_io_vec; 13011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1302ffb25dc60ff14f90a581975307b0c1d07e1f362aKent Overstreet bio_reset(pkt->w_bio); 13034f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet pkt->w_bio->bi_iter.bi_sector = pkt->sector; 1304ffb25dc60ff14f90a581975307b0c1d07e1f362aKent Overstreet pkt->w_bio->bi_bdev = pd->bdev; 1305ffb25dc60ff14f90a581975307b0c1d07e1f362aKent Overstreet pkt->w_bio->bi_end_io = pkt_end_io_packet_write; 1306ffb25dc60ff14f90a581975307b0c1d07e1f362aKent Overstreet pkt->w_bio->bi_private = pkt; 1307ffb25dc60ff14f90a581975307b0c1d07e1f362aKent Overstreet 1308ffb25dc60ff14f90a581975307b0c1d07e1f362aKent Overstreet /* XXX: locking? */ 13091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (f = 0; f < pkt->frames; f++) { 13107277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_page = pkt->pages[(f * CD_FRAMESIZE) / PAGE_SIZE]; 13117277232374680595cdbc774fd246b206f56db015Peter Osterlund bvec[f].bv_offset = (f * CD_FRAMESIZE) % PAGE_SIZE; 1312ffb25dc60ff14f90a581975307b0c1d07e1f362aKent Overstreet if (!bio_add_page(pkt->w_bio, bvec[f].bv_page, CD_FRAMESIZE, bvec[f].bv_offset)) 1313ffb25dc60ff14f90a581975307b0c1d07e1f362aKent Overstreet BUG(); 13141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1315844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "vcnt=%d\n", pkt->w_bio->bi_vcnt); 13161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 13187277232374680595cdbc774fd246b206f56db015Peter Osterlund * Fill-in bvec with data from orig_bios. 13191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 13201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 1321ffb25dc60ff14f90a581975307b0c1d07e1f362aKent Overstreet bio_copy_data(pkt->w_bio, pkt->orig_bios.head); 13221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_WRITE_WAIT_STATE); 13241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 13251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1326844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "Writing %d frames for zone %llx\n", 1327ffb25dc60ff14f90a581975307b0c1d07e1f362aKent Overstreet pkt->write_size, (unsigned long long)pkt->sector); 13281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (test_bit(PACKET_MERGE_SEGS, &pd->flags) || (pkt->write_size < pkt->frames)) { 13307277232374680595cdbc774fd246b206f56db015Peter Osterlund pkt_make_local_copy(pkt, bvec); 13311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 1; 13321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 13331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 0; 13341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Start the write request */ 13371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->io_wait, 1); 13381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->w_bio->bi_rw = WRITE; 133946c271bedd2c8444b1d05bc44928beec0c07debcPeter Osterlund pkt_queue_bio(pd, pkt->w_bio); 13401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 13411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_finish_packet(struct packet_data *pkt, int uptodate) 13431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1344c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita struct bio *bio; 13451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!uptodate) 13471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->cache_valid = 0; 13481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Finish all bios corresponding to this packet */ 1350c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita while ((bio = bio_list_pop(&pkt->orig_bios))) 13516712ecf8f648118c3363c142196418f89a510b90NeilBrown bio_endio(bio, uptodate ? 0 : -EIO); 13521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 13531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_run_state_machine(struct pktcdvd_device *pd, struct packet_data *pkt) 13551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 13561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int uptodate; 13571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1358844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "pkt %d\n", pkt->id); 13591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 13611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (pkt->state) { 13621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_WAITING_STATE: 13631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pkt->write_size < pkt->frames) && (pkt->sleep_time > 0)) 13641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 13651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time = 0; 13671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_gather_data(pd, pkt); 13681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_READ_WAIT_STATE); 13691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 13701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_READ_WAIT_STATE: 13721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->io_wait) > 0) 13731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 13741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->io_errors) > 0) { 13761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_RECOVERY_STATE); 13771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 13781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_start_write(pd, pkt); 13791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 13811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_WRITE_WAIT_STATE: 13831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->io_wait) > 0) 13841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 13851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (test_bit(BIO_UPTODATE, &pkt->w_bio->bi_flags)) { 13871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_FINISHED_STATE); 13881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 13891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_RECOVERY_STATE); 13901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 13911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 13921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 13931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_RECOVERY_STATE: 13941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt_start_recovery(pkt)) { 13951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_start_write(pd, pkt); 13961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 1397844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "No recovery possible\n"); 13981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_FINISHED_STATE); 13991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 14011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_FINISHED_STATE: 14031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds uptodate = test_bit(BIO_UPTODATE, &pkt->w_bio->bi_flags); 14041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_finish_packet(pkt, uptodate); 14051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 14061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 14081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG(); 14091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 14101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 14131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_handle_packets(struct pktcdvd_device *pd) 14151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 14161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt, *next; 14171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 14191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Run state machine for active packets 14201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 14211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 14221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->run_sm) > 0) { 14231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pkt->run_sm, 0); 14241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_run_state_machine(pd, pkt); 14251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 14291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Move no longer active packets to the free list 14301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 14311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 14321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry_safe(pkt, next, &pd->cdrw.pkt_active_list, list) { 14331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->state == PACKET_FINISHED_STATE) { 14341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_del(&pkt->list); 14351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_put_packet_data(pd, pkt); 14361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_state(pkt, PACKET_IDLE_STATE); 14371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->scan_queue, 1); 14381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 14411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 14421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_count_states(struct pktcdvd_device *pd, int *states) 14441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 14451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 14461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 14471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1448ae7642bb05623988d8ca82b332dad1ed7bdb8cebPeter Osterlund for (i = 0; i < PACKET_NUM_STATES; i++) 14491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[i] = 0; 14501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 14521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 14531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[pkt->state]++; 14541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 14561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 14571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 14591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * kcdrwd is woken up when writes have been queued for one of our 14601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * registered devices 14611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 14621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int kcdrwd(void *foobar) 14631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 14641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = foobar; 14651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 14661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds long min_sleep_time, residue; 14671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14688698a745d800c59cd5a576398bdeccd578ac66f1Dongsheng Yang set_user_nice(current, MIN_NICE); 1469831441862956fffa17b9801db37e6ea1650b0f69Rafael J. Wysocki set_freezable(); 14701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 14721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DECLARE_WAITQUEUE(wait, current); 14731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 14751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Wait until there is something to do 14761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 14771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_wait_queue(&pd->wqueue, &wait); 14781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 14791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_current_state(TASK_INTERRUPTIBLE); 14801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check if we need to run pkt_handle_queue */ 14821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->scan_queue) > 0) 14831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto work_to_do; 14841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check if we need to run the state machine for some packet */ 14861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 14871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pkt->run_sm) > 0) 14881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto work_to_do; 14891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 14901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Check if we need to process the iosched queues */ 14921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (atomic_read(&pd->iosched.attention) != 0) 14931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto work_to_do; 14941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 14951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Otherwise, go to sleep */ 14961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (PACKET_DEBUG > 1) { 14971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int states[PACKET_NUM_STATES]; 14981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_count_states(pd, states); 1499844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "i:%d ow:%d rw:%d ww:%d rec:%d fin:%d\n", 1500cd3f2cd05cf1066f3975ed3223f12c799bc553c6Joe Perches states[0], states[1], states[2], 1501cd3f2cd05cf1066f3975ed3223f12c799bc553c6Joe Perches states[3], states[4], states[5]); 15021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds min_sleep_time = MAX_SCHEDULE_TIMEOUT; 15051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 15061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sleep_time && pkt->sleep_time < min_sleep_time) 15071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds min_sleep_time = pkt->sleep_time; 15081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1510844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "sleeping\n"); 15111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds residue = schedule_timeout(min_sleep_time); 1512844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "wake up\n"); 15131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* make swsusp happy with our thread */ 15153e1d1d28d99dabe63c64f7f40f1ca1d646de1f73Christoph Lameter try_to_freeze(); 15161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 15181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt->sleep_time) 15191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 15201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time -= min_sleep_time - residue; 15211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sleep_time <= 0) { 15221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt->sleep_time = 0; 15231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 15241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (kthread_should_stop()) 15281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 15291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldswork_to_do: 15311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_current_state(TASK_RUNNING); 15321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remove_wait_queue(&pd->wqueue, &wait); 15331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (kthread_should_stop()) 15351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 15361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 15381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * if pkt_handle_queue returns true, we can queue 15391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * another request. 15401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 15411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (pkt_handle_queue(pd)) 15421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ; 15431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 15451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Handle packet state machine 15461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 15471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_handle_packets(pd); 15481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 15501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Handle iosched queues 15511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 15521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_iosched_process_queue(pd); 15531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 15541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 15561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_print_settings(struct pktcdvd_device *pd) 15591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 15600c075d64df3aa9636a8700a710a2f2ada5e453a2Joe Perches pkt_info(pd, "%s packets, %u blocks, Mode-%c disc\n", 15610c075d64df3aa9636a8700a710a2f2ada5e453a2Joe Perches pd->settings.fp ? "Fixed" : "Variable", 15620c075d64df3aa9636a8700a710a2f2ada5e453a2Joe Perches pd->settings.size >> 2, 15630c075d64df3aa9636a8700a710a2f2ada5e453a2Joe Perches pd->settings.block_mode == 8 ? '1' : '2'); 15641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_mode_sense(struct pktcdvd_device *pd, struct packet_command *cgc, int page_code, int page_control) 15671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 15681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(cgc->cmd, 0, sizeof(cgc->cmd)); 15691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[0] = GPCMD_MODE_SENSE_10; 15711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[2] = page_code | (page_control << 6); 15721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[7] = cgc->buflen >> 8; 15731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[8] = cgc->buflen & 0xff; 15741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->data_direction = CGC_DATA_READ; 15751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, cgc); 15761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_mode_select(struct pktcdvd_device *pd, struct packet_command *cgc) 15791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 15801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(cgc->cmd, 0, sizeof(cgc->cmd)); 15811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(cgc->buffer, 0, 2); 15821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[0] = GPCMD_MODE_SELECT_10; 15831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[1] = 0x10; /* PF */ 15841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[7] = cgc->buflen >> 8; 15851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->cmd[8] = cgc->buflen & 0xff; 15861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc->data_direction = CGC_DATA_WRITE; 15871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, cgc); 15881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 15891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_get_disc_info(struct pktcdvd_device *pd, disc_information *di) 15911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 15921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 15931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 15941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 15951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* set up command and get the disc info */ 15961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, di, sizeof(*di), CGC_DATA_READ); 15971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_DISC_INFO; 15981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = cgc.buflen = 2; 15991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 16001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 16021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 16031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* not all drives have the same disc_info length, so requeue 16051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * packet with the length the drive tells us it can supply 16061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 16071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = be16_to_cpu(di->disc_information_length) + 16081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(di->disc_information_length); 16091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cgc.buflen > sizeof(disc_information)) 16111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = sizeof(disc_information); 16121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = cgc.buflen; 16141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 16151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 16161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_get_track_info(struct pktcdvd_device *pd, __u16 track, __u8 type, track_information *ti) 16181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 16201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 16211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, ti, 8, CGC_DATA_READ); 16231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_TRACK_RZONE_INFO; 16241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = type & 3; 16251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[4] = (track & 0xff00) >> 8; 16261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[5] = track & 0xff; 16271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = 8; 16281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 16291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 16311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 16321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = be16_to_cpu(ti->track_information_length) + 16341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(ti->track_information_length); 16351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cgc.buflen > sizeof(track_information)) 16371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = sizeof(track_information); 16381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = cgc.buflen; 16401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 16411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 16421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 164305680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_get_last_written(struct pktcdvd_device *pd, 164405680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlund long *last_written) 16451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disc_information di; 16471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds track_information ti; 16481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __u32 last_track; 16491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = -1; 16501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_disc_info(pd, &di))) 16521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 16531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last_track = (di.last_track_msb << 8) | di.last_track_lsb; 16551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_track_info(pd, last_track, 1, &ti))) 16561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 16571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* if this track is blank, try the previous. */ 16591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.blank) { 16601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds last_track--; 16611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_track_info(pd, last_track, 1, &ti))) 16621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 16631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* if last recorded field is valid, return it. */ 16661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.lra_v) { 16671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *last_written = be32_to_cpu(ti.last_rec_address); 16681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 16691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* make it up instead */ 16701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *last_written = be32_to_cpu(ti.track_start) + 16711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds be32_to_cpu(ti.track_size); 16721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.free_blocks) 16731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *last_written -= (be32_to_cpu(ti.free_blocks) + 7); 16741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 16751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 16761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 16771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 16791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * write mode select package based on pd->settings 16801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 168105680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_set_write_settings(struct pktcdvd_device *pd) 16821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 16831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 16841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 16851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_param_page *wp; 16861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char buffer[128]; 16871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret, size; 16881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* doesn't apply to DVD+RW or DVD-RAM */ 16901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pd->mmc3_profile == 0x1a) || (pd->mmc3_profile == 0x12)) 16911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 16921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 16931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(buffer, 0, sizeof(buffer)); 16941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buffer, sizeof(*wp), CGC_DATA_READ); 16951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 16961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_sense(pd, &cgc, GPMODE_WRITE_PARMS_PAGE, 0))) { 1697f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perches pkt_dump_sense(pd, &cgc); 16981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 16991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 17001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = 2 + ((buffer[0] << 8) | (buffer[1] & 0xff)); 17021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->mode_offset = (buffer[6] << 8) | (buffer[7] & 0xff); 17031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (size > sizeof(buffer)) 17041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = sizeof(buffer); 17051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 17071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * now get it all 17081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 17091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buffer, size, CGC_DATA_READ); 17101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 17111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_sense(pd, &cgc, GPMODE_WRITE_PARMS_PAGE, 0))) { 1712f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perches pkt_dump_sense(pd, &cgc); 17131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 17151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 17171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * write page is offset header + block descriptor length 17181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 17191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp = (write_param_page *) &buffer[sizeof(struct mode_page_header) + pd->mode_offset]; 17201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->fp = pd->settings.fp; 17221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->track_mode = pd->settings.track_mode; 17231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->write_type = pd->settings.write_type; 17241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->data_block_type = pd->settings.block_mode; 17251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->multi_session = 0; 17271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef PACKET_USE_LS 17291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->link_size = 7; 17301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->ls_v = 1; 17311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 17321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (wp->data_block_type == PACKET_BLOCK_MODE1) { 17341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->session_format = 0; 17351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->subhdr2 = 0x20; 17361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (wp->data_block_type == PACKET_BLOCK_MODE2) { 17371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->session_format = 0x20; 17381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->subhdr2 = 8; 17391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#if 0 17401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->mcn[0] = 0x80; 17411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memcpy(&wp->mcn[1], PACKET_MCN, sizeof(wp->mcn) - 1); 17421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 17431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 17441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 17451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * paranoia 17461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1747fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "write mode wrong %d\n", wp->data_block_type); 17481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 17491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 17501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wp->packet_size = cpu_to_be32(pd->settings.size >> 2); 17511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = cgc.cmd[8] = size; 17531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_select(pd, &cgc))) { 1754f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perches pkt_dump_sense(pd, &cgc); 17551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 17561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 17571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_print_settings(pd); 17591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 17601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 17637c613d593370292d1685f5794c743a2323be3a09Peter Osterlund * 1 -- we can write to this track, 0 -- we can't 17641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1765ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlundstatic int pkt_writable_track(struct pktcdvd_device *pd, track_information *ti) 17661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1767ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund switch (pd->mmc3_profile) { 1768ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund case 0x1a: /* DVD+RW */ 1769ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund case 0x12: /* DVD-RAM */ 1770ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund /* The track is always writable on DVD+RW/DVD-RAM */ 1771ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund return 1; 1772ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund default: 1773ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund break; 1774ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund } 17751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1776ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (!ti->packet || !ti->fp) 1777ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund return 0; 17781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 17801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * "good" settings as per Mt Fuji. 17811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 1782ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (ti->rt == 0 && ti->blank == 0) 17837c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 17841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1785ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (ti->rt == 0 && ti->blank == 1) 17867c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 17871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1788ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (ti->rt == 1 && ti->blank == 0) 17897c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 17901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1791fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "bad state %d-%d-%d\n", ti->rt, ti->blank, ti->packet); 17927c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 17931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 17941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 17951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 17967c613d593370292d1685f5794c743a2323be3a09Peter Osterlund * 1 -- we can write to this disc, 0 -- we can't 17971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 17987c613d593370292d1685f5794c743a2323be3a09Peter Osterlundstatic int pkt_writable_disc(struct pktcdvd_device *pd, disc_information *di) 17991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 18001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (pd->mmc3_profile) { 18011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x0a: /* CD-RW */ 18021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0xffff: /* MMC3 not supported */ 18031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 18041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x1a: /* DVD+RW */ 18051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x13: /* DVD-RW */ 18061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x12: /* DVD-RAM */ 18077c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 18081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 1809844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "Wrong disc profile (%x)\n", 1810cd3f2cd05cf1066f3975ed3223f12c799bc553c6Joe Perches pd->mmc3_profile); 18117c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 18121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 18151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * for disc type 0xff we should probably reserve a new track. 18161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * but i'm not sure, should we leave this to user apps? probably. 18171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 18181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->disc_type == 0xff) { 1819ca73dabc3d1df4aaacb242b6d4e39cd36618444fJoe Perches pkt_notice(pd, "unknown disc - no track?\n"); 18207c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 18211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->disc_type != 0x20 && di->disc_type != 0) { 1824fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "wrong disc type (%x)\n", di->disc_type); 18257c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 18261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->erasable == 0) { 1829ca73dabc3d1df4aaacb242b6d4e39cd36618444fJoe Perches pkt_notice(pd, "disc not erasable\n"); 18307c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 18311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (di->border_status == PACKET_SESSION_RESERVED) { 1834fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "can't write to last track (reserved)\n"); 18357c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 0; 18361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18387c613d593370292d1685f5794c743a2323be3a09Peter Osterlund return 1; 18391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 18401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 184105680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_probe_settings(struct pktcdvd_device *pd) 18421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 18431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 18441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[12]; 18451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disc_information di; 18461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds track_information ti; 18471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret, track; 18481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, sizeof(buf), CGC_DATA_READ); 18501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_GET_CONFIGURATION; 18511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = 8; 18521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_generic_packet(pd, &cgc); 18531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->mmc3_profile = ret ? 0xffff : buf[6] << 8 | buf[7]; 18541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&di, 0, sizeof(disc_information)); 18561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(&ti, 0, sizeof(track_information)); 18571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_disc_info(pd, &di))) { 1859fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "failed get_disc\n"); 18601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 18611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18637c613d593370292d1685f5794c743a2323be3a09Peter Osterlund if (!pkt_writable_disc(pd, &di)) 18649db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 18651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->type = di.erasable ? PACKET_CDRW : PACKET_CDR; 18671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds track = 1; /* (di.last_track_msb << 8) | di.last_track_lsb; */ 18691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_track_info(pd, track, 1, &ti))) { 1870fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "failed get_track\n"); 18711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 18721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1874ab863ec342cf148d02ed180b8ecf3a71a024e4bePeter Osterlund if (!pkt_writable_track(pd, &ti)) { 1875fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "can't write to this track\n"); 18769db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 18771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 18801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * we keep packet size in 512 byte units, makes it easier to 18811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * deal with request calculations. 18821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 18831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.size = be32_to_cpu(ti.fixed_packet_size) << 2; 18841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->settings.size == 0) { 1885ca73dabc3d1df4aaacb242b6d4e39cd36618444fJoe Perches pkt_notice(pd, "detected zero packet size!\n"); 1886a460ad62260def15c42130de253d6cfc32528a2fPhillip Susi return -ENXIO; 18871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1888d0272e78eee4dc53c887fd132e9035daf037d423Peter Osterlund if (pd->settings.size > PACKET_MAX_SECTORS) { 1889fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "packet size is too big\n"); 18909db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 1891d0272e78eee4dc53c887fd132e9035daf037d423Peter Osterlund } 18921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.fp = ti.fp; 18931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->offset = (be32_to_cpu(ti.track_start) << 2) & (pd->settings.size - 1); 18941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 18951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.nwa_v) { 18961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->nwa = be32_to_cpu(ti.next_writable); 18971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_NWA_VALID, &pd->flags); 18981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 18991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 19011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * in theory we could use lra on -RW media as well and just zero 19021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * blocks that haven't been written yet, but in practice that 19031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * is just a no-go. we'll use that for -R, naturally. 19041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 19051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ti.lra_v) { 19061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->lra = be32_to_cpu(ti.last_rec_address); 19071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_LRA_VALID, &pd->flags); 19081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 19091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->lra = 0xffffffff; 19101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_LRA_VALID, &pd->flags); 19111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 19141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * fine for now 19151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 19161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.link_loss = 7; 19171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.write_type = 0; /* packet */ 19181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.track_mode = ti.track_mode; 19191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 19211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * mode1 or mode2 disc 19221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 19231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (ti.data_mode) { 19241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_MODE1: 19251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.block_mode = PACKET_BLOCK_MODE1; 19261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 19271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PACKET_MODE2: 19281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->settings.block_mode = PACKET_BLOCK_MODE2; 19291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 19301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 1931fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "unknown data mode\n"); 19329db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return -EROFS; 19331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 19341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 19351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 19361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 19381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * enable/disable write caching on drive 19391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 194005680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_write_caching(struct pktcdvd_device *pd, 194105680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlund int set) 19421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 19431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 19441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 19451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[64]; 19461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 19471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, sizeof(buf), CGC_DATA_READ); 19491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 19501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = pd->mode_offset + 12; 19511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 19531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * caching mode page might not be there, so quiet this command 19541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 19551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.quiet = 1; 19561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_mode_sense(pd, &cgc, GPMODE_WCACHING_PAGE, 0))) 19581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 19591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf[pd->mode_offset + 10] |= (!!set << 2); 19611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = cgc.cmd[8] = 2 + ((buf[0] << 8) | (buf[1] & 0xff)); 19631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_mode_select(pd, &cgc); 19641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 1965fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "write caching control failed\n"); 1966f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perches pkt_dump_sense(pd, &cgc); 19671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (!ret && set) 1968ca73dabc3d1df4aaacb242b6d4e39cd36618444fJoe Perches pkt_notice(pd, "enabled write caching\n"); 19691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 19701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 19711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_lock_door(struct pktcdvd_device *pd, int lockflag) 19731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 19741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 19751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 19771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL; 19781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[4] = lockflag ? 1 : 0; 19791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_generic_packet(pd, &cgc); 19801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 19811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 19831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Returns drive maximum write speed 19841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 198505680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_get_max_speed(struct pktcdvd_device *pd, 198605680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlund unsigned *write_speed) 19871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 19881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 19891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 19901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[256+18]; 19911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char *cap_buf; 19921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret, offset; 19931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cap_buf = &buf[sizeof(struct mode_page_header) + pd->mode_offset]; 19951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, sizeof(buf), CGC_DATA_UNKNOWN); 19961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 19971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_mode_sense(pd, &cgc, GPMODE_CAPABILITIES_PAGE, 0); 19991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 20001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.buflen = pd->mode_offset + cap_buf[1] + 2 + 20011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(struct mode_page_header); 20021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_mode_sense(pd, &cgc, GPMODE_CAPABILITIES_PAGE, 0); 20031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 2004f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perches pkt_dump_sense(pd, &cgc); 20051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 20061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = 20; /* Obsoleted field, used by older drives */ 20101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cap_buf[1] >= 28) 20111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = 28; /* Current write speed selected */ 20121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cap_buf[1] >= 30) { 20131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* If the drive reports at least one "Logical Unit Write 20141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Speed Performance Descriptor Block", use the information 20151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * in the first block. (contains the highest speed) 20161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 20171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int num_spdb = (cap_buf[30] << 8) + cap_buf[31]; 20181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (num_spdb > 0) 20191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds offset = 34; 20201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *write_speed = (cap_buf[offset] << 8) | cap_buf[offset + 1]; 20231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 20241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 20251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* These tables from cdrecord - I don't have orange book */ 20271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* standard speed CD-RW (1-4x) */ 20281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic char clv_to_speed[16] = { 20291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */ 20301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0, 2, 4, 6, 8, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 20311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 20321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* high speed CD-RW (-10x) */ 20331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic char hs_clv_to_speed[16] = { 20341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */ 20351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0, 2, 4, 6, 10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 20361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 20371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* ultra high speed CD-RW */ 20381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic char us_clv_to_speed[16] = { 20391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */ 20401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0, 2, 4, 8, 0, 0,16, 0,24,32,40,48, 0, 0, 0, 0 20411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 20421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 20441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * reads the maximum media speed from ATIP 20451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 204605680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_media_speed(struct pktcdvd_device *pd, 204705680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlund unsigned *speed) 20481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 20491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 20501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 20511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char buf[64]; 20521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int size, st, sp; 20531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 20541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, 2, CGC_DATA_READ); 20561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 20571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_TOC_PMA_ATIP; 20581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 2; 20591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[2] = 4; /* READ ATIP */ 20601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = 2; 20611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_generic_packet(pd, &cgc); 20621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 2063f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perches pkt_dump_sense(pd, &cgc); 20641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 20651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = ((unsigned int) buf[0]<<8) + buf[1] + 2; 20671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (size > sizeof(buf)) 20681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = sizeof(buf); 20691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, buf, size, CGC_DATA_READ); 20711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 20721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_READ_TOC_PMA_ATIP; 20731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 2; 20741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[2] = 4; 20751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[8] = size; 20761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_generic_packet(pd, &cgc); 20771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 2078f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perches pkt_dump_sense(pd, &cgc); 20791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 20801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2082eaa0ff15c30dc9799eb4d12660edb73aeb6d32c5Alexey Dobriyan if (!(buf[6] & 0x40)) { 2083ca73dabc3d1df4aaacb242b6d4e39cd36618444fJoe Perches pkt_notice(pd, "disc type is not CD-RW\n"); 20841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 20851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2086eaa0ff15c30dc9799eb4d12660edb73aeb6d32c5Alexey Dobriyan if (!(buf[6] & 0x4)) { 2087ca73dabc3d1df4aaacb242b6d4e39cd36618444fJoe Perches pkt_notice(pd, "A1 values on media are not valid, maybe not CDRW?\n"); 20881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 20891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 20901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds st = (buf[6] >> 3) & 0x7; /* disc sub-type */ 20921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sp = buf[16] & 0xf; /* max speed from ATIP A1 field */ 20941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 20951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Info from cdrecord */ 20961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (st) { 20971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0: /* standard speed */ 20981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *speed = clv_to_speed[sp]; 20991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 21001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 1: /* high speed */ 21011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *speed = hs_clv_to_speed[sp]; 21021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 21031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 2: /* ultra high speed */ 21041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *speed = us_clv_to_speed[sp]; 21051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 21061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 2107ca73dabc3d1df4aaacb242b6d4e39cd36618444fJoe Perches pkt_notice(pd, "unknown disc sub-type %d\n", st); 21081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 21091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (*speed) { 21110c075d64df3aa9636a8700a710a2f2ada5e453a2Joe Perches pkt_info(pd, "maximum media speed: %d\n", *speed); 21121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 21131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 2114ca73dabc3d1df4aaacb242b6d4e39cd36618444fJoe Perches pkt_notice(pd, "unknown speed %d for sub-type %d\n", sp, st); 21151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 1; 21161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 21181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 211905680d86d21bdbe56db80c66c24c686590815f1fPeter Osterlundstatic noinline_for_stack int pkt_perform_opc(struct pktcdvd_device *pd) 21201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 21211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_command cgc; 21221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request_sense sense; 21231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 21241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2125844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "Performing OPC\n"); 21261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_cdrom_command(&cgc, NULL, 0, CGC_DATA_NONE); 21281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.sense = &sense; 21291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.timeout = 60*HZ; 21301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[0] = GPCMD_SEND_OPC; 21311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cgc.cmd[1] = 1; 21321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_generic_packet(pd, &cgc))) 2133f3ded788bbd95af344a34ae40d1ab578cb76c7fbJoe Perches pkt_dump_sense(pd, &cgc); 21341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 21351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 21361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_open_write(struct pktcdvd_device *pd) 21381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 21391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 21401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int write_speed, media_write_speed, read_speed; 21411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_probe_settings(pd))) { 2143844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "failed probe\n"); 21449db91546570ca1b3bc90b4c2d25d5bb74a44be24Peter Osterlund return ret; 21451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_set_write_settings(pd))) { 2148844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(1, pd, "failed saving write settings\n"); 21491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 21501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_write_caching(pd, USE_WCACHING); 21531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_max_speed(pd, &write_speed))) 21551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_speed = 16 * 177; 21561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (pd->mmc3_profile) { 21571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x13: /* DVD-RW */ 21581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x1a: /* DVD+RW */ 21591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case 0x12: /* DVD-RAM */ 2160844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(1, pd, "write speed %ukB/s\n", write_speed); 21611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 21621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 21631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_media_speed(pd, &media_write_speed))) 21641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds media_write_speed = 16; 21651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds write_speed = min(write_speed, media_write_speed * 177); 2166844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(1, pd, "write speed %ux\n", write_speed / 176); 21671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 21681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds read_speed = write_speed; 21701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_set_speed(pd, write_speed, read_speed))) { 2172844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(1, pd, "couldn't set write speed\n"); 21731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EIO; 21741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->write_speed = write_speed; 21761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->read_speed = read_speed; 21771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_perform_opc(pd))) { 2179844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(1, pd, "Optimum Power Calibration failed\n"); 21801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 21811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 21831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 21841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * called at open time. 21871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2188aeb5d727062a0238a2f96c9c380fbd2be4640c6fAl Virostatic int pkt_open_dev(struct pktcdvd_device *pd, fmode_t write) 21891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 21901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 21911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds long lba; 2192165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboe struct request_queue *q; 21931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 21941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 21951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * We need to re-open the cdrom device without O_NONBLOCK to be able 21961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * to read/write from/to it. It is already opened in O_NONBLOCK mode 21971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * so bdget() can't fail. 21981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 21991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdget(pd->bdev->bd_dev); 2200e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo if ((ret = blkdev_get(pd->bdev, FMODE_READ | FMODE_EXCL, pd))) 22011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 22021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_get_last_written(pd, &lba))) { 2204fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "pkt_get_last_written failed\n"); 2205e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo goto out_putdev; 22061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_capacity(pd->disk, lba << 2); 22091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_capacity(pd->bdev->bd_disk, lba << 2); 22101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bd_set_size(pd->bdev, (loff_t)lba << 11); 22111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds q = bdev_get_queue(pd->bdev); 22131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (write) { 22141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_open_write(pd))) 2215e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo goto out_putdev; 22161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 22171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Some CDRW drives can not handle writes larger than one packet, 22181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * even if the size is a multiple of the packet size. 22191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 22201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_irq(q->queue_lock); 2221086fa5ff0854c676ec333760f4c0154b3b242616Martin K. Petersen blk_queue_max_hw_sectors(q, pd->settings.size); 22221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock_irq(q->queue_lock); 22231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_bit(PACKET_WRITABLE, &pd->flags); 22241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 22251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, MAX_SPEED, MAX_SPEED); 22261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds clear_bit(PACKET_WRITABLE, &pd->flags); 22271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((ret = pkt_set_segment_merging(pd, q))) 2230e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo goto out_putdev; 22311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2232e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund if (write) { 2233e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund if (!pkt_grow_pktlist(pd, CONFIG_CDROM_PKTCDVD_BUFFERS)) { 2234fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "not enough memory for buffers\n"); 2235e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund ret = -ENOMEM; 2236e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo goto out_putdev; 2237e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund } 22380c075d64df3aa9636a8700a710a2f2ada5e453a2Joe Perches pkt_info(pd, "%lukB available on disc\n", lba << 1); 2239e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund } 22401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 22421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_putdev: 2244e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo blkdev_put(pd->bdev, FMODE_READ | FMODE_EXCL); 22451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 22461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 22471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 22481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 22501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * called when the device is closed. makes sure that the device flushes 22511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the internal cache before we close. 22521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 22531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_release_dev(struct pktcdvd_device *pd, int flush) 22541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 22551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (flush && pkt_flush_cache(pd)) 2256844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(1, pd, "not flushing cache\n"); 22571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_lock_door(pd, 0); 22591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_set_speed(pd, MAX_SPEED, MAX_SPEED); 2261e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo blkdev_put(pd->bdev, FMODE_READ | FMODE_EXCL); 2262e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund 2263e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund pkt_shrink_pktlist(pd); 22641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 22651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2266252a52aa4fa22a668f019e55b3aac3ff71ec1c29Dan Rosenbergstatic struct pktcdvd_device *pkt_find_dev_from_minor(unsigned int dev_minor) 22671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 22681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev_minor >= MAX_WRITERS) 22691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return NULL; 22701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return pkt_devs[dev_minor]; 22711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 22721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22735e5e007c25009c304af693b7fc49bab8d1d25801Al Virostatic int pkt_open(struct block_device *bdev, fmode_t mode) 22741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 22751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = NULL; 22761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 22771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22782a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_lock(&pktcdvd_mutex); 22791657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_lock(&ctl_mutex); 22805e5e007c25009c304af693b7fc49bab8d1d25801Al Viro pd = pkt_find_dev_from_minor(MINOR(bdev->bd_dev)); 22811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd) { 22821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENODEV; 22831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out; 22841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 22851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->refcnt < 0); 22861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 22871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->refcnt++; 228846f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund if (pd->refcnt > 1) { 22895e5e007c25009c304af693b7fc49bab8d1d25801Al Viro if ((mode & FMODE_WRITE) && 229046f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund !test_bit(PACKET_WRITABLE, &pd->flags)) { 229146f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund ret = -EBUSY; 229246f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund goto out_dec; 229346f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund } 229446f4e1b7d5fa3ddf2486bf69716c404147e38ebfPeter Osterlund } else { 22955e5e007c25009c304af693b7fc49bab8d1d25801Al Viro ret = pkt_open_dev(pd, mode & FMODE_WRITE); 229601fd9fda2ce462b44bafdac2fe6aacacf23531f2Peter Osterlund if (ret) 22971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_dec; 22981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 22991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * needed here as well, since ext2 (among others) may change 23001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the blocksize at mount time 23011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 23025e5e007c25009c304af693b7fc49bab8d1d25801Al Viro set_blocksize(bdev, CD_FRAMESIZE); 23031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23051657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_unlock(&ctl_mutex); 23062a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_unlock(&pktcdvd_mutex); 23071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 23081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_dec: 23101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->refcnt--; 23111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 23121657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_unlock(&ctl_mutex); 23132a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_unlock(&pktcdvd_mutex); 23141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 23151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 23161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2317db2a144bedd58b3dcf19950c2f476c58c9f39d18Al Virostatic void pkt_close(struct gendisk *disk, fmode_t mode) 23181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 23195e5e007c25009c304af693b7fc49bab8d1d25801Al Viro struct pktcdvd_device *pd = disk->private_data; 23201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23212a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_lock(&pktcdvd_mutex); 23221657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_lock(&ctl_mutex); 23231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->refcnt--; 23241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->refcnt < 0); 23251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->refcnt == 0) { 23261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int flush = test_bit(PACKET_WRITABLE, &pd->flags); 23271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_release_dev(pd, flush); 23281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23291657f824e880a9bd239a3436b820d1a2986f763dJes Sorensen mutex_unlock(&ctl_mutex); 23302a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_unlock(&pktcdvd_mutex); 23311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 23321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23346712ecf8f648118c3363c142196418f89a510b90NeilBrownstatic void pkt_end_io_read_cloned(struct bio *bio, int err) 23351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 23361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_stacked_data *psd = bio->bi_private; 23371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = psd->pd; 23381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bio_put(bio); 23406712ecf8f648118c3363c142196418f89a510b90NeilBrown bio_endio(psd->bio, err); 23411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_free(psd, psd_pool); 23421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_bio_finished(pd); 23431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 23441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 234520d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreetstatic void pkt_make_request_read(struct pktcdvd_device *pd, struct bio *bio) 23461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 234720d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet struct bio *cloned_bio = bio_clone(bio, GFP_NOIO); 234820d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet struct packet_stacked_data *psd = mempool_alloc(psd_pool, GFP_NOIO); 234920d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet 235020d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet psd->pd = pd; 235120d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet psd->bio = bio; 235220d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet cloned_bio->bi_bdev = pd->bdev; 235320d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet cloned_bio->bi_private = psd; 235420d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet cloned_bio->bi_end_io = pkt_end_io_read_cloned; 235520d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet pd->stats.secs_r += bio_sectors(bio); 235620d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet pkt_queue_bio(pd, cloned_bio); 235720d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet} 235820d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet 235920d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreetstatic void pkt_make_request_write(struct request_queue *q, struct bio *bio) 236020d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet{ 236120d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet struct pktcdvd_device *pd = q->queuedata; 23621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sector_t zone; 23631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct packet_data *pkt; 23641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int was_empty, blocked_bio; 23651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_rb_node *node; 23661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23674f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet zone = get_zone(bio->bi_iter.bi_sector, pd); 23681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 23701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * If we find a matching packet in state WAITING or READ_WAIT, we can 23711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * just append this bio to that packet. 23721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 23731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->cdrw.active_list_lock); 23741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blocked_bio = 0; 23751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds list_for_each_entry(pkt, &pd->cdrw.pkt_active_list, list) { 23761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pkt->sector == zone) { 23771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pkt->lock); 23781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pkt->state == PACKET_WAITING_STATE) || 23791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (pkt->state == PACKET_READ_WAIT_STATE)) { 2380c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_add(&pkt->orig_bios, bio); 23814f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet pkt->write_size += 23824f024f3797c43cb4b73cd2c50cec728842d0e49eKent Overstreet bio->bi_iter.bi_size / CD_FRAMESIZE; 23831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((pkt->write_size >= pkt->frames) && 23841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (pkt->state == PACKET_WAITING_STATE)) { 23851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_inc(&pkt->run_sm); 23861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 23871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 23891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 23905a7bbad27a410350e64a2d7f5ec18fc73836c14fChristoph Hellwig return; 23911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 23921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blocked_bio = 1; 23931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pkt->lock); 23951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 23971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->cdrw.active_list_lock); 23981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 23990a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier /* 24000a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier * Test if there is enough room left in the bio work queue 24010a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier * (queue size >= congestion on mark). 24020a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier * If not, wait till the work queue size is below the congestion off mark. 24030a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier */ 24040a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_lock(&pd->lock); 24050a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier if (pd->write_congestion_on > 0 24060a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier && pd->bio_queue_size >= pd->write_congestion_on) { 24078aa7e847d834ed937a9ad37a0f2ad5b8584c1ab0Jens Axboe set_bdi_congested(&q->backing_dev_info, BLK_RW_ASYNC); 24080a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier do { 24090a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_unlock(&pd->lock); 24108aa7e847d834ed937a9ad37a0f2ad5b8584c1ab0Jens Axboe congestion_wait(BLK_RW_ASYNC, HZ); 24110a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_lock(&pd->lock); 24120a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier } while(pd->bio_queue_size > pd->write_congestion_off); 24130a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier } 24140a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier spin_unlock(&pd->lock); 24150a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier 24161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 24171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * No matching packet found. Store the bio in the work queue. 24181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 24191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node = mempool_alloc(pd->rb_pool, GFP_NOIO); 24201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds node->bio = bio; 24211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&pd->lock); 24221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(pd->bio_queue_size < 0); 24231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds was_empty = (pd->bio_queue_size == 0); 24241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_rbtree_insert(pd, node); 24251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&pd->lock); 24261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 24271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 24281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Wake up the worker thread. 24291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 24301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->scan_queue, 1); 24311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (was_empty) { 24321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This wake_up is required for correct operation */ 24331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 24341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else if (!list_empty(&pd->cdrw.pkt_free_list) && !blocked_bio) { 24351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 24361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This wake up is not required for correct operation, 24371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * but improves performance in some cases. 24381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 24391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&pd->wqueue); 24401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 244120d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet} 244220d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet 244320d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreetstatic void pkt_make_request(struct request_queue *q, struct bio *bio) 244420d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet{ 244520d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet struct pktcdvd_device *pd; 244620d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet char b[BDEVNAME_SIZE]; 244720d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet struct bio *split; 244820d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet 244920d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet pd = q->queuedata; 245020d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet if (!pd) { 245120d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet pr_err("%s incorrect request queue\n", 245220d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet bdevname(bio->bi_bdev, b)); 245320d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet goto end_io; 245420d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet } 245520d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet 245620d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet pkt_dbg(2, pd, "start = %6llx stop = %6llx\n", 245720d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet (unsigned long long)bio->bi_iter.bi_sector, 245820d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet (unsigned long long)bio_end_sector(bio)); 245920d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet 246020d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet /* 246120d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet * Clone READ bios so we can have our own bi_end_io callback. 246220d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet */ 246320d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet if (bio_data_dir(bio) == READ) { 246420d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet pkt_make_request_read(pd, bio); 246520d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet return; 246620d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet } 246720d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet 246820d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet if (!test_bit(PACKET_WRITABLE, &pd->flags)) { 246920d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet pkt_notice(pd, "WRITE for ro device (%llu)\n", 247020d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet (unsigned long long)bio->bi_iter.bi_sector); 247120d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet goto end_io; 247220d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet } 247320d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet 247420d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet if (!bio->bi_iter.bi_size || (bio->bi_iter.bi_size % CD_FRAMESIZE)) { 247520d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet pkt_err(pd, "wrong bio size\n"); 247620d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet goto end_io; 247720d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet } 247820d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet 247920d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet blk_queue_bounce(q, &bio); 248020d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet 248120d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet do { 248220d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet sector_t zone = get_zone(bio->bi_iter.bi_sector, pd); 248320d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet sector_t last_zone = get_zone(bio_end_sector(bio) - 1, pd); 248420d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet 248520d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet if (last_zone != zone) { 248620d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet BUG_ON(last_zone != zone + pd->settings.size); 248720d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet 248820d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet split = bio_split(bio, last_zone - 248920d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet bio->bi_iter.bi_sector, 249020d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet GFP_NOIO, fs_bio_set); 249120d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet bio_chain(split, bio); 249220d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet } else { 249320d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet split = bio; 249420d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet } 249520d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet 249620d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet pkt_make_request_write(q, split); 249720d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet } while (split != bio); 249820d0189b1012a37d2533a87fb451f7852f2418d1Kent Overstreet 24995a7bbad27a410350e64a2d7f5ec18fc73836c14fChristoph Hellwig return; 25001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsend_io: 25016712ecf8f648118c3363c142196418f89a510b90NeilBrown bio_io_error(bio); 25021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 25031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2506cc371e66e340f35eed8dc4651c7c18e754c7fb26Alasdair G Kergonstatic int pkt_merge_bvec(struct request_queue *q, struct bvec_merge_data *bmd, 2507cc371e66e340f35eed8dc4651c7c18e754c7fb26Alasdair G Kergon struct bio_vec *bvec) 25081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 25091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = q->queuedata; 25105323fb770b6254a4c218a2dfb0ef9aa007b7725aJoe Perches sector_t zone = get_zone(bmd->bi_sector, pd); 2511cc371e66e340f35eed8dc4651c7c18e754c7fb26Alasdair G Kergon int used = ((bmd->bi_sector - zone) << 9) + bmd->bi_size; 25121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int remaining = (pd->settings.size << 9) - used; 25131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int remaining2; 25141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 25161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * A bio <= PAGE_SIZE must be allowed. If it crosses a packet 25171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * boundary, pkt_make_request() will split the bio. 25181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2519cc371e66e340f35eed8dc4651c7c18e754c7fb26Alasdair G Kergon remaining2 = PAGE_SIZE - bmd->bi_size; 25201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remaining = max(remaining, remaining2); 25211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BUG_ON(remaining < 0); 25231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return remaining; 25241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 25251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_init_queue(struct pktcdvd_device *pd) 25271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2528165125e1e480f9510a5ffcfbfee4e3ee38c05f23Jens Axboe struct request_queue *q = pd->disk->queue; 25291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_make_request(q, pkt_make_request); 2531e1defc4ff0cf57aca6c5e3ff99fa503f5943c1f1Martin K. Petersen blk_queue_logical_block_size(q, CD_FRAMESIZE); 2532086fa5ff0854c676ec333760f4c0154b3b242616Martin K. Petersen blk_queue_max_hw_sectors(q, PACKET_MAX_SECTORS); 25331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds blk_queue_merge_bvec(q, pkt_merge_bvec); 25341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds q->queuedata = pd; 25351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 25361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_seq_show(struct seq_file *m, void *p) 25381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 25391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = m->private; 25401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char *msg; 25411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char bdev_buf[BDEVNAME_SIZE]; 25421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int states[PACKET_NUM_STATES]; 25431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "Writer %s mapped to %s:\n", pd->name, 25451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdevname(pd->bdev, bdev_buf)); 25461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nSettings:\n"); 25481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpacket size:\t\t%dkB\n", pd->settings.size / 2); 25491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->settings.write_type == 0) 25511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Packet"; 25521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 25531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Unknown"; 25541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\twrite type:\t\t%s\n", msg); 25551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpacket type:\t\t%s\n", pd->settings.fp ? "Fixed" : "Variable"); 25571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tlink loss:\t\t%d\n", pd->settings.link_loss); 25581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\ttrack mode:\t\t%d\n", pd->settings.track_mode); 25601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->settings.block_mode == PACKET_BLOCK_MODE1) 25621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Mode 1"; 25631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else if (pd->settings.block_mode == PACKET_BLOCK_MODE2) 25641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Mode 2"; 25651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 25661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds msg = "Unknown"; 25671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tblock mode:\t\t%s\n", msg); 25681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nStatistics:\n"); 25701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpackets started:\t%lu\n", pd->stats.pkt_started); 25711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tpackets ended:\t\t%lu\n", pd->stats.pkt_ended); 25721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\twritten:\t\t%lukB\n", pd->stats.secs_w >> 1); 25731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tread gather:\t\t%lukB\n", pd->stats.secs_rg >> 1); 25741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tread:\t\t\t%lukB\n", pd->stats.secs_r >> 1); 25751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nMisc:\n"); 25771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\treference count:\t%d\n", pd->refcnt); 25781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tflags:\t\t\t0x%lx\n", pd->flags); 25791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tread speed:\t\t%ukB/s\n", pd->read_speed); 25801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\twrite speed:\t\t%ukB/s\n", pd->write_speed); 25811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tstart offset:\t\t%lu\n", pd->offset); 25821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tmode page offset:\t%u\n", pd->mode_offset); 25831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\nQueue state:\n"); 25851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tbios queued:\t\t%d\n", pd->bio_queue_size); 25861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tbios pending:\t\t%d\n", atomic_read(&pd->cdrw.pending_bios)); 25871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tcurrent sector:\t\t0x%llx\n", (unsigned long long)pd->current_sector); 25881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_count_states(pd, states); 25901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seq_printf(m, "\tstate:\t\t\ti:%d ow:%d rw:%d ww:%d rec:%d fin:%d\n", 25911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds states[0], states[1], states[2], states[3], states[4], states[5]); 25921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25930a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier seq_printf(m, "\twrite congestion marks:\toff=%d on=%d\n", 25940a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_off, 25950a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_on); 25961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 25971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 25981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 25991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_seq_open(struct inode *inode, struct file *file) 26001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2601d9dda78bad879595d8c4220a067fc029d6484a16Al Viro return single_open(file, pkt_seq_show, PDE_DATA(inode)); 26021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 26031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26042b8693c0617e972fc0b2fd1ebf8de97e15b656c3Arjan van de Venstatic const struct file_operations pkt_proc_fops = { 26051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .open = pkt_seq_open, 26061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .read = seq_read, 26071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .llseek = seq_lseek, 26081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .release = single_release 26091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 26101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int pkt_new_dev(struct pktcdvd_device *pd, dev_t dev) 26121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 26131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int i; 26141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = 0; 26151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char b[BDEVNAME_SIZE]; 26161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct block_device *bdev; 26171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->pkt_dev == dev) { 2619fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "recursive setup not allowed\n"); 26201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 26211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 26221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (i = 0; i < MAX_WRITERS; i++) { 26231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd2 = pkt_devs[i]; 26241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd2) 26251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 26261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd2->bdev->bd_dev == dev) { 2627fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "%s already setup\n", 2628fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches bdevname(pd2->bdev, b)); 26291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 26301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 26311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd2->pkt_dev == dev) { 2632fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "can't chain pktcdvd devices\n"); 26331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 26341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 26351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 26361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds bdev = bdget(dev); 26381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!bdev) 26391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 2640e525fd89d380c4a94c0d63913a1dd1a593ed25e7Tejun Heo ret = blkdev_get(bdev, FMODE_READ | FMODE_NDELAY, NULL); 26411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) 26421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 26431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This is safe, since we have a reference from open(). */ 26451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds __module_get(THIS_MODULE); 26461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bdev = bdev; 26481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_blocksize(bdev, CD_FRAMESIZE); 26491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_init_queue(pd); 26511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds atomic_set(&pd->cdrw.pending_bios, 0); 26531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->cdrw.thread = kthread_run(kcdrwd, pd, "%s", pd->name); 26541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (IS_ERR(pd->cdrw.thread)) { 2655fa63c0ab81f55eb5a016c1bcea04fe39c14afbaaJoe Perches pkt_err(pd, "can't start kernel thread\n"); 26561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = -ENOMEM; 2657e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund goto out_mem; 26581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 26591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2660c7705f3449c7edd5c1744871097f93977227afc4Denis V. Lunev proc_create_data(pd->name, 0, pkt_proc, &pkt_proc_fops, pd); 2661844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(1, pd, "writer mapped to %s\n", bdevname(bdev, b)); 26621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 26631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_mem: 26652cbed8906fd1f3c6cc17cdf8aac1bfad2da7960cAl Viro blkdev_put(bdev, FMODE_READ | FMODE_NDELAY); 26661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This is safe: open() is still holding a reference. */ 26671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds module_put(THIS_MODULE); 26681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 26691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 26701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26715e5e007c25009c304af693b7fc49bab8d1d25801Al Virostatic int pkt_ioctl(struct block_device *bdev, fmode_t mode, unsigned int cmd, unsigned long arg) 26721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 26735e5e007c25009c304af693b7fc49bab8d1d25801Al Viro struct pktcdvd_device *pd = bdev->bd_disk->private_data; 26748a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann int ret; 26751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2676844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "cmd %x, dev %d:%d\n", 2677cd3f2cd05cf1066f3975ed3223f12c799bc553c6Joe Perches cmd, MAJOR(bdev->bd_dev), MINOR(bdev->bd_dev)); 26781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 26792a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_lock(&pktcdvd_mutex); 26801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 2681a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro case CDROMEJECT: 2682a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro /* 2683a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro * The door gets locked when the device is opened, so we 2684a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro * have to unlock it or else the eject command fails. 2685a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro */ 2686a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro if (pd->refcnt == 1) 2687a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro pkt_lock_door(pd, 0); 2688a0eb62a0a4470fef5a5f41e7f1442fdd667220efAl Viro /* fallthru */ 26891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 26901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * forward selected CDROM ioctls to CD-ROM, for UDF 26911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 26921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROMMULTISESSION: 26931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROMREADTOCENTRY: 26941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROM_LAST_WRITTEN: 26951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CDROM_SEND_PACKET: 26961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case SCSI_IOCTL_SEND_COMMAND: 26978a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann ret = __blkdev_driver_ioctl(pd->bdev, mode, cmd, arg); 26988a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann break; 26991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 2701844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(2, pd, "Unknown ioctl (%x)\n", cmd); 27028a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann ret = -ENOTTY; 27031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 27042a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_unlock(&pktcdvd_mutex); 27058560c650f340565b720fd57d1f9c99ab216d99d0Linus Torvalds 27068a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann return ret; 27071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 27081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27093c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heostatic unsigned int pkt_check_events(struct gendisk *disk, 27103c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo unsigned int clearing) 27111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 27121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd = disk->private_data; 27131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct gendisk *attached_disk; 27141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd) 27161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 27171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd->bdev) 27181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 27191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds attached_disk = pd->bdev->bd_disk; 27203c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo if (!attached_disk || !attached_disk->fops->check_events) 27211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 27223c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo return attached_disk->fops->check_events(attached_disk, clearing); 27231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 27241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 272583d5cde47dedf01b6a4a4331882cbc0a7eea3c2eAlexey Dobriyanstatic const struct block_device_operations pktcdvd_ops = { 27261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 27275e5e007c25009c304af693b7fc49bab8d1d25801Al Viro .open = pkt_open, 27285e5e007c25009c304af693b7fc49bab8d1d25801Al Viro .release = pkt_close, 27298a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann .ioctl = pkt_ioctl, 27303c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo .check_events = pkt_check_events, 27311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 27321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27332c9ede55ecec58099b72e4bb8eab719f32f72c31Al Virostatic char *pktcdvd_devnode(struct gendisk *gd, umode_t *mode) 2734b03f38b685e2e1db174fb8982930e789a516f414Kay Sievers{ 2735b03f38b685e2e1db174fb8982930e789a516f414Kay Sievers return kasprintf(GFP_KERNEL, "pktcdvd/%s", gd->disk_name); 2736b03f38b685e2e1db174fb8982930e789a516f414Kay Sievers} 2737b03f38b685e2e1db174fb8982930e789a516f414Kay Sievers 27381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 27391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Set up mapping from pktcdvd device to CD-ROM device. 27401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2741adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierstatic int pkt_setup_dev(dev_t dev, dev_t* pkt_dev) 27421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 27431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int idx; 27441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = -ENOMEM; 27451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd; 27461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct gendisk *disk; 2747adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2748adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 27491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (idx = 0; idx < MAX_WRITERS; idx++) 27511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pkt_devs[idx]) 27521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 27531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (idx == MAX_WRITERS) { 275499481334bcab1330fce0c590b845b4a95b101a69Joe Perches pr_err("max %d writers supported\n", MAX_WRITERS); 2755adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = -EBUSY; 2756adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out_mutex; 27571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 27581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27591107d2e0352769b9bde6a4877c295b9309cdb877Peter Osterlund pd = kzalloc(sizeof(struct pktcdvd_device), GFP_KERNEL); 27601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd) 2761adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out_mutex; 27621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27630eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson pd->rb_pool = mempool_create_kmalloc_pool(PKT_RB_POOL_SIZE, 27640eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson sizeof(struct pkt_rb_node)); 27651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!pd->rb_pool) 27661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_mem; 27671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2768e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund INIT_LIST_HEAD(&pd->cdrw.pkt_free_list); 2769e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund INIT_LIST_HEAD(&pd->cdrw.pkt_active_list); 2770e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund spin_lock_init(&pd->cdrw.active_list_lock); 2771e1bc89bc9991e994f2b3c60d9ad2fdb5ad9b10fcPeter Osterlund 27721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_init(&pd->lock); 27731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock_init(&pd->iosched.lock); 2774c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_init(&pd->iosched.read_queue); 2775c5ecc484c528ff50bdbb16fbfbac758ee368b329Akinobu Mita bio_list_init(&pd->iosched.write_queue); 27767822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier sprintf(pd->name, DRIVER_NAME"%d", idx); 27771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_waitqueue_head(&pd->wqueue); 27781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd->bio_queue = RB_ROOT; 27791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 27800a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_on = write_congestion_on; 27810a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier pd->write_congestion_off = write_congestion_off; 27820a0fc9601dd1024ec7171993bf075a789246e1edThomas Maier 2783adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier disk = alloc_disk(1); 2784adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier if (!disk) 2785adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out_mem; 2786adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier pd->disk = disk; 2787add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier disk->major = pktdev_major; 27881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->first_minor = idx; 27891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->fops = &pktcdvd_ops; 27901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->flags = GENHD_FL_REMOVABLE; 2791adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier strcpy(disk->disk_name, pd->name); 2792e454cea20bdcff10ee698d11b8882662a0153a47Kay Sievers disk->devnode = pktcdvd_devnode; 27931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->private_data = pd; 27941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disk->queue = blk_alloc_queue(GFP_KERNEL); 27951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!disk->queue) 27961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_mem2; 27971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2798f331c0296f2a9fee0d396a70598b954062603015Tejun Heo pd->pkt_dev = MKDEV(pktdev_major, idx); 27991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = pkt_new_dev(pd, dev); 28001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) 28011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_new_dev; 28021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28033c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo /* inherit events of the host device */ 28043c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo disk->events = pd->bdev->bd_disk->events; 28053c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo disk->async_events = pd->bdev->bd_disk->async_events; 28063c0d206092f50be82523dba2b0e0a02de9e6aad3Tejun Heo 28071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_disk(disk); 2808adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 280932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_dev_new(pd); 281032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_dev_new(pd); 281132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 28121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_devs[idx] = pd; 2813adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier if (pkt_dev) 2814adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier *pkt_dev = pd->pkt_dev; 2815adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2816adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 28171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 28181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_new_dev: 28201312f40e11c57edb5c3250f1b782cef8e3efea82Al Viro blk_cleanup_queue(disk->queue); 28211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_mem2: 28221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds put_disk(disk); 28231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_mem: 28241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd->rb_pool) 28251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(pd->rb_pool); 28261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pd); 2827adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierout_mutex: 2828adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 282999481334bcab1330fce0c590b845b4a95b101a69Joe Perches pr_err("setup of pktcdvd device failed\n"); 28301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 28311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 28321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 28341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Tear down mapping from pktcdvd device to CD-ROM device. 28351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 2836adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierstatic int pkt_remove_dev(dev_t pkt_dev) 28371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 28381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pktcdvd_device *pd; 28391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int idx; 2840adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier int ret = 0; 2841adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2842adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 28431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (idx = 0; idx < MAX_WRITERS; idx++) { 28451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pd = pkt_devs[idx]; 28461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd && (pd->pkt_dev == pkt_dev)) 28471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 28481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 28491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (idx == MAX_WRITERS) { 2850666dc7c90ab2531f7f0f13ef21afab8cd61478a9Joe Perches pr_debug("dev not setup\n"); 2851adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = -ENXIO; 2852adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out; 28531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 28541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2855adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier if (pd->refcnt > 0) { 2856adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = -EBUSY; 2857adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier goto out; 2858adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier } 28591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!IS_ERR(pd->cdrw.thread)) 28601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kthread_stop(pd->cdrw.thread); 28611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 286232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_devs[idx] = NULL; 286332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 286432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_dev_remove(pd); 286532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_dev_remove(pd); 286632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 28672cbed8906fd1f3c6cc17cdf8aac1bfad2da7960cAl Viro blkdev_put(pd->bdev, FMODE_READ | FMODE_NDELAY); 28681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds remove_proc_entry(pd->name, pkt_proc); 2870844aa7974395df1f0c7a866007e900e5f979fc7bJoe Perches pkt_dbg(1, pd, "writer unmapped\n"); 28711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds del_gendisk(pd->disk); 28731312f40e11c57edb5c3250f1b782cef8e3efea82Al Viro blk_cleanup_queue(pd->disk->queue); 28741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds put_disk(pd->disk); 28751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(pd->rb_pool); 28771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds kfree(pd); 28781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* This is safe: open() is still holding a reference. */ 28801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds module_put(THIS_MODULE); 2881adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2882adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maierout: 2883adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 2884adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier return ret; 28851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 28861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 28871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void pkt_get_status(struct pkt_ctrl_command *ctrl_cmd) 28881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2889adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier struct pktcdvd_device *pd; 2890adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2891adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_lock_nested(&ctl_mutex, SINGLE_DEPTH_NESTING); 2892adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2893adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier pd = pkt_find_dev_from_minor(ctrl_cmd->dev_index); 28941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (pd) { 28951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->dev = new_encode_dev(pd->bdev->bd_dev); 28961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->pkt_dev = new_encode_dev(pd->pkt_dev); 28971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 28981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->dev = 0; 28991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->pkt_dev = 0; 29001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 29011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ctrl_cmd->num_devices = MAX_WRITERS; 2902adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier 2903adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier mutex_unlock(&ctl_mutex); 29041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 29051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2906f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmannstatic long pkt_ctl_ioctl(struct file *file, unsigned int cmd, unsigned long arg) 29071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 29081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void __user *argp = (void __user *)arg; 29091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct pkt_ctrl_command ctrl_cmd; 29101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret = 0; 2911adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier dev_t pkt_dev = 0; 29121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cmd != PACKET_CTRL_CMD) 29141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOTTY; 29151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_from_user(&ctrl_cmd, argp, sizeof(struct pkt_ctrl_command))) 29171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 29181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (ctrl_cmd.command) { 29201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PKT_CTRL_CMD_SETUP: 29211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!capable(CAP_SYS_ADMIN)) 29221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EPERM; 2923adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = pkt_setup_dev(new_decode_dev(ctrl_cmd.dev), &pkt_dev); 2924adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ctrl_cmd.pkt_dev = new_encode_dev(pkt_dev); 29251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 29261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PKT_CTRL_CMD_TEARDOWN: 29271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!capable(CAP_SYS_ADMIN)) 29281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EPERM; 2929adb9250a07edb7d41a17ba3b96fcb84c4d8e4260Thomas Maier ret = pkt_remove_dev(new_decode_dev(ctrl_cmd.pkt_dev)); 29301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 29311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case PKT_CTRL_CMD_STATUS: 29321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pkt_get_status(&ctrl_cmd); 29331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 29341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 29351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOTTY; 29361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 29371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_to_user(argp, &ctrl_cmd, sizeof(struct pkt_ctrl_command))) 29391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 29401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 29411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 29421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2943f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann#ifdef CONFIG_COMPAT 2944f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmannstatic long pkt_ctl_compat_ioctl(struct file *file, unsigned int cmd, unsigned long arg) 2945f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann{ 2946f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann return pkt_ctl_ioctl(file, cmd, (unsigned long)compat_ptr(arg)); 2947f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann} 2948f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann#endif 29491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29502b8693c0617e972fc0b2fd1ebf8de97e15b656c3Arjan van de Venstatic const struct file_operations pkt_ctl_fops = { 2951f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann .open = nonseekable_open, 2952f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann .unlocked_ioctl = pkt_ctl_ioctl, 2953f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann#ifdef CONFIG_COMPAT 2954f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann .compat_ioctl = pkt_ctl_compat_ioctl, 2955f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann#endif 2956f80a0ca6ad8f2800453e819dafa09a0ed9e56850Arnd Bergmann .owner = THIS_MODULE, 29576038f373a3dc1f1c26496e60b6c40b164716f07eArnd Bergmann .llseek = no_llseek, 29581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 29591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct miscdevice pkt_misc = { 29611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .minor = MISC_DYNAMIC_MINOR, 29627822082d4e054fbdec8cf26590a350e3496c5cc9Thomas Maier .name = DRIVER_NAME, 2963e454cea20bdcff10ee698d11b8882662a0153a47Kay Sievers .nodename = "pktcdvd/control", 29641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .fops = &pkt_ctl_fops 29651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 29661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 29671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int __init pkt_init(void) 29681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 29691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret; 29701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 297132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier mutex_init(&ctl_mutex); 297232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 29730eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson psd_pool = mempool_create_kmalloc_pool(PSD_POOL_SIZE, 29740eaae62abaa1ad1f231932b6cdd9fb1b91df6651Matthew Dobson sizeof(struct packet_stacked_data)); 29751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!psd_pool) 29761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 29771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2978add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier ret = register_blkdev(pktdev_major, DRIVER_NAME); 29791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret < 0) { 298099481334bcab1330fce0c590b845b4a95b101a69Joe Perches pr_err("unable to register block device\n"); 29811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out2; 29821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2983add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier if (!pktdev_major) 2984add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier pktdev_major = ret; 29851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 298632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier ret = pkt_sysfs_init(); 298732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier if (ret) 298832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier goto out; 298932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 299032694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_init(); 299132694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 29921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = misc_register(&pkt_misc); 29931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) { 299499481334bcab1330fce0c590b845b4a95b101a69Joe Perches pr_err("unable to register misc device\n"); 299532694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier goto out_misc; 29961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 29971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2998928b4d8c8963e75bdb133f562b03b07f9aa4844aAlexey Dobriyan pkt_proc = proc_mkdir("driver/"DRIVER_NAME, NULL); 29991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 30011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 300232694850a91bd4fedcdd4a46292f870588be81d1Thomas Maierout_misc: 300332694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_cleanup(); 300432694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_cleanup(); 30051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout: 3006add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier unregister_blkdev(pktdev_major, DRIVER_NAME); 30071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout2: 30081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(psd_pool); 30091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 30101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 30111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void __exit pkt_exit(void) 30131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3014928b4d8c8963e75bdb133f562b03b07f9aa4844aAlexey Dobriyan remove_proc_entry("driver/"DRIVER_NAME, NULL); 30151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds misc_deregister(&pkt_misc); 301632694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 301732694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_debugfs_cleanup(); 301832694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier pkt_sysfs_cleanup(); 301932694850a91bd4fedcdd4a46292f870588be81d1Thomas Maier 3020add216608a63713b8a2c4545698d5ae02e27ac3bThomas Maier unregister_blkdev(pktdev_major, DRIVER_NAME); 30211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mempool_destroy(psd_pool); 30221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 30231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DESCRIPTION("Packet writing layer for CD/DVD drives"); 30251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Jens Axboe <axboe@suse.de>"); 30261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 30271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 30281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(pkt_init); 30291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_exit(pkt_exit); 3030