2 * Copyright (C) 2000 Jens Axboe <axboe@suse.de>
3 * Copyright (C) 2001-2004 Peter Osterlund <petero2@telia.com>
4 * Copyright (C) 2006 Thomas Maier <balagi@justmail.de>
6 * May be copied or modified under the terms of the GNU General Public
7 * License. See linux/COPYING for more information.
9 * Packet writing layer for ATAPI and SCSI CD-RW, DVD+RW, DVD-RW and
12 * Theory of operation:
14 * At the lowest level, there is the standard driver for the CD/DVD device,
15 * such as drivers/scsi/sr.c. This driver can handle read and write requests,
16 * but it doesn't know anything about the special restrictions that apply to
17 * packet writing. One restriction is that write requests must be aligned to
18 * packet boundaries on the physical media, and the size of a write request
19 * must be equal to the packet size. Another restriction is that a
20 * GPCMD_FLUSH_CACHE command has to be issued to the drive before a read
21 * command, if the previous command was a write.
23 * The purpose of the packet writing driver is to hide these restrictions from
24 * higher layers, such as file systems, and present a block device that can be
25 * randomly read and written using 2kB-sized blocks.
27 * The lowest layer in the packet writing driver is the packet I/O scheduler.
28 * Its data is defined by the struct packet_iosched and includes two bio
29 * queues with pending read and write requests. These queues are processed
30 * by the pkt_iosched_process_queue() function. The write requests in this
31 * queue are already properly aligned and sized. This layer is responsible for
32 * issuing the flush cache commands and scheduling the I/O in a good order.
34 * The next layer transforms unaligned write requests to aligned writes. This
35 * transformation requires reading missing pieces of data from the underlying
36 * block device, assembling the pieces to full packets and queuing them to the
37 * packet I/O scheduler.
39 * At the top layer there is a custom ->submit_bio function that forwards
40 * read requests directly to the iosched queue and puts write requests in the
41 * unaligned write queue. A kernel thread performs the necessary read
42 * gathering to convert the unaligned writes to aligned writes and then feeds
43 * them to the packet I/O scheduler.
45 *************************************************************************/
47 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
49 #include <linux/backing-dev.h>
50 #include <linux/compat.h>
51 #include <linux/debugfs.h>
52 #include <linux/device.h>
53 #include <linux/errno.h>
54 #include <linux/file.h>
55 #include <linux/freezer.h>
56 #include <linux/kernel.h>
57 #include <linux/kthread.h>
58 #include <linux/miscdevice.h>
59 #include <linux/module.h>
60 #include <linux/mutex.h>
61 #include <linux/nospec.h>
62 #include <linux/pktcdvd.h>
63 #include <linux/proc_fs.h>
64 #include <linux/seq_file.h>
65 #include <linux/slab.h>
66 #include <linux/spinlock.h>
67 #include <linux/types.h>
68 #include <linux/uaccess.h>
70 #include <scsi/scsi.h>
71 #include <scsi/scsi_cmnd.h>
72 #include <scsi/scsi_ioctl.h>
74 #include <asm/unaligned.h>
76 #define DRIVER_NAME "pktcdvd"
78 #define MAX_SPEED 0xffff
80 static DEFINE_MUTEX(pktcdvd_mutex
);
81 static struct pktcdvd_device
*pkt_devs
[MAX_WRITERS
];
82 static struct proc_dir_entry
*pkt_proc
;
83 static int pktdev_major
;
84 static int write_congestion_on
= PKT_WRITE_CONGESTION_ON
;
85 static int write_congestion_off
= PKT_WRITE_CONGESTION_OFF
;
86 static struct mutex ctl_mutex
; /* Serialize open/close/setup/teardown */
87 static mempool_t psd_pool
;
88 static struct bio_set pkt_bio_set
;
90 /* /sys/class/pktcdvd */
91 static struct class class_pktcdvd
;
92 static struct dentry
*pkt_debugfs_root
= NULL
; /* /sys/kernel/debug/pktcdvd */
94 /* forward declaration */
95 static int pkt_setup_dev(dev_t dev
, dev_t
* pkt_dev
);
96 static int pkt_remove_dev(dev_t pkt_dev
);
98 static sector_t
get_zone(sector_t sector
, struct pktcdvd_device
*pd
)
100 return (sector
+ pd
->offset
) & ~(sector_t
)(pd
->settings
.size
- 1);
103 /**********************************************************
104 * sysfs interface for pktcdvd
105 * by (C) 2006 Thomas Maier <balagi@justmail.de>
107 /sys/class/pktcdvd/pktcdvd[0-7]/
110 stat/packets_finished
115 write_queue/congestion_off
116 write_queue/congestion_on
117 **********************************************************/
119 static ssize_t
packets_started_show(struct device
*dev
,
120 struct device_attribute
*attr
, char *buf
)
122 struct pktcdvd_device
*pd
= dev_get_drvdata(dev
);
124 return sysfs_emit(buf
, "%lu\n", pd
->stats
.pkt_started
);
126 static DEVICE_ATTR_RO(packets_started
);
128 static ssize_t
packets_finished_show(struct device
*dev
,
129 struct device_attribute
*attr
, char *buf
)
131 struct pktcdvd_device
*pd
= dev_get_drvdata(dev
);
133 return sysfs_emit(buf
, "%lu\n", pd
->stats
.pkt_ended
);
135 static DEVICE_ATTR_RO(packets_finished
);
137 static ssize_t
kb_written_show(struct device
*dev
,
138 struct device_attribute
*attr
, char *buf
)
140 struct pktcdvd_device
*pd
= dev_get_drvdata(dev
);
142 return sysfs_emit(buf
, "%lu\n", pd
->stats
.secs_w
>> 1);
144 static DEVICE_ATTR_RO(kb_written
);
146 static ssize_t
kb_read_show(struct device
*dev
,
147 struct device_attribute
*attr
, char *buf
)
149 struct pktcdvd_device
*pd
= dev_get_drvdata(dev
);
151 return sysfs_emit(buf
, "%lu\n", pd
->stats
.secs_r
>> 1);
153 static DEVICE_ATTR_RO(kb_read
);
155 static ssize_t
kb_read_gather_show(struct device
*dev
,
156 struct device_attribute
*attr
, char *buf
)
158 struct pktcdvd_device
*pd
= dev_get_drvdata(dev
);
160 return sysfs_emit(buf
, "%lu\n", pd
->stats
.secs_rg
>> 1);
162 static DEVICE_ATTR_RO(kb_read_gather
);
164 static ssize_t
reset_store(struct device
*dev
, struct device_attribute
*attr
,
165 const char *buf
, size_t len
)
167 struct pktcdvd_device
*pd
= dev_get_drvdata(dev
);
170 pd
->stats
.pkt_started
= 0;
171 pd
->stats
.pkt_ended
= 0;
172 pd
->stats
.secs_w
= 0;
173 pd
->stats
.secs_rg
= 0;
174 pd
->stats
.secs_r
= 0;
178 static DEVICE_ATTR_WO(reset
);
180 static struct attribute
*pkt_stat_attrs
[] = {
181 &dev_attr_packets_finished
.attr
,
182 &dev_attr_packets_started
.attr
,
183 &dev_attr_kb_read
.attr
,
184 &dev_attr_kb_written
.attr
,
185 &dev_attr_kb_read_gather
.attr
,
186 &dev_attr_reset
.attr
,
190 static const struct attribute_group pkt_stat_group
= {
192 .attrs
= pkt_stat_attrs
,
195 static ssize_t
size_show(struct device
*dev
,
196 struct device_attribute
*attr
, char *buf
)
198 struct pktcdvd_device
*pd
= dev_get_drvdata(dev
);
201 spin_lock(&pd
->lock
);
202 n
= sysfs_emit(buf
, "%d\n", pd
->bio_queue_size
);
203 spin_unlock(&pd
->lock
);
206 static DEVICE_ATTR_RO(size
);
208 static void init_write_congestion_marks(int* lo
, int* hi
)
212 *hi
= min(*hi
, 1000000);
216 *lo
= min(*lo
, *hi
- 100);
225 static ssize_t
congestion_off_show(struct device
*dev
,
226 struct device_attribute
*attr
, char *buf
)
228 struct pktcdvd_device
*pd
= dev_get_drvdata(dev
);
231 spin_lock(&pd
->lock
);
232 n
= sysfs_emit(buf
, "%d\n", pd
->write_congestion_off
);
233 spin_unlock(&pd
->lock
);
237 static ssize_t
congestion_off_store(struct device
*dev
,
238 struct device_attribute
*attr
,
239 const char *buf
, size_t len
)
241 struct pktcdvd_device
*pd
= dev_get_drvdata(dev
);
244 ret
= kstrtoint(buf
, 10, &val
);
248 spin_lock(&pd
->lock
);
249 pd
->write_congestion_off
= val
;
250 init_write_congestion_marks(&pd
->write_congestion_off
, &pd
->write_congestion_on
);
251 spin_unlock(&pd
->lock
);
254 static DEVICE_ATTR_RW(congestion_off
);
256 static ssize_t
congestion_on_show(struct device
*dev
,
257 struct device_attribute
*attr
, char *buf
)
259 struct pktcdvd_device
*pd
= dev_get_drvdata(dev
);
262 spin_lock(&pd
->lock
);
263 n
= sysfs_emit(buf
, "%d\n", pd
->write_congestion_on
);
264 spin_unlock(&pd
->lock
);
268 static ssize_t
congestion_on_store(struct device
*dev
,
269 struct device_attribute
*attr
,
270 const char *buf
, size_t len
)
272 struct pktcdvd_device
*pd
= dev_get_drvdata(dev
);
275 ret
= kstrtoint(buf
, 10, &val
);
279 spin_lock(&pd
->lock
);
280 pd
->write_congestion_on
= val
;
281 init_write_congestion_marks(&pd
->write_congestion_off
, &pd
->write_congestion_on
);
282 spin_unlock(&pd
->lock
);
285 static DEVICE_ATTR_RW(congestion_on
);
287 static struct attribute
*pkt_wq_attrs
[] = {
288 &dev_attr_congestion_on
.attr
,
289 &dev_attr_congestion_off
.attr
,
294 static const struct attribute_group pkt_wq_group
= {
295 .name
= "write_queue",
296 .attrs
= pkt_wq_attrs
,
299 static const struct attribute_group
*pkt_groups
[] = {
305 static void pkt_sysfs_dev_new(struct pktcdvd_device
*pd
)
307 if (class_is_registered(&class_pktcdvd
)) {
308 pd
->dev
= device_create_with_groups(&class_pktcdvd
, NULL
,
309 MKDEV(0, 0), pd
, pkt_groups
,
310 "%s", pd
->disk
->disk_name
);
316 static void pkt_sysfs_dev_remove(struct pktcdvd_device
*pd
)
318 if (class_is_registered(&class_pktcdvd
))
319 device_unregister(pd
->dev
);
323 /********************************************************************
326 remove unmap packet dev
327 device_map show mappings
328 *******************************************************************/
330 static ssize_t
device_map_show(const struct class *c
, const struct class_attribute
*attr
,
335 mutex_lock_nested(&ctl_mutex
, SINGLE_DEPTH_NESTING
);
336 for (idx
= 0; idx
< MAX_WRITERS
; idx
++) {
337 struct pktcdvd_device
*pd
= pkt_devs
[idx
];
340 n
+= sysfs_emit_at(data
, n
, "%s %u:%u %u:%u\n",
342 MAJOR(pd
->pkt_dev
), MINOR(pd
->pkt_dev
),
343 MAJOR(file_bdev(pd
->bdev_file
)->bd_dev
),
344 MINOR(file_bdev(pd
->bdev_file
)->bd_dev
));
346 mutex_unlock(&ctl_mutex
);
349 static CLASS_ATTR_RO(device_map
);
351 static ssize_t
add_store(const struct class *c
, const struct class_attribute
*attr
,
352 const char *buf
, size_t count
)
354 unsigned int major
, minor
;
356 if (sscanf(buf
, "%u:%u", &major
, &minor
) == 2) {
357 /* pkt_setup_dev() expects caller to hold reference to self */
358 if (!try_module_get(THIS_MODULE
))
361 pkt_setup_dev(MKDEV(major
, minor
), NULL
);
363 module_put(THIS_MODULE
);
370 static CLASS_ATTR_WO(add
);
372 static ssize_t
remove_store(const struct class *c
, const struct class_attribute
*attr
,
373 const char *buf
, size_t count
)
375 unsigned int major
, minor
;
376 if (sscanf(buf
, "%u:%u", &major
, &minor
) == 2) {
377 pkt_remove_dev(MKDEV(major
, minor
));
382 static CLASS_ATTR_WO(remove
);
384 static struct attribute
*class_pktcdvd_attrs
[] = {
385 &class_attr_add
.attr
,
386 &class_attr_remove
.attr
,
387 &class_attr_device_map
.attr
,
390 ATTRIBUTE_GROUPS(class_pktcdvd
);
392 static struct class class_pktcdvd
= {
394 .class_groups
= class_pktcdvd_groups
,
397 static int pkt_sysfs_init(void)
400 * create control files in sysfs
401 * /sys/class/pktcdvd/...
403 return class_register(&class_pktcdvd
);
406 static void pkt_sysfs_cleanup(void)
408 class_unregister(&class_pktcdvd
);
411 /********************************************************************
414 /sys/kernel/debug/pktcdvd[0-7]/
417 *******************************************************************/
419 static void pkt_count_states(struct pktcdvd_device
*pd
, int *states
)
421 struct packet_data
*pkt
;
424 for (i
= 0; i
< PACKET_NUM_STATES
; i
++)
427 spin_lock(&pd
->cdrw
.active_list_lock
);
428 list_for_each_entry(pkt
, &pd
->cdrw
.pkt_active_list
, list
) {
429 states
[pkt
->state
]++;
431 spin_unlock(&pd
->cdrw
.active_list_lock
);
434 static int pkt_seq_show(struct seq_file
*m
, void *p
)
436 struct pktcdvd_device
*pd
= m
->private;
438 int states
[PACKET_NUM_STATES
];
440 seq_printf(m
, "Writer %s mapped to %pg:\n", pd
->disk
->disk_name
,
441 file_bdev(pd
->bdev_file
));
443 seq_printf(m
, "\nSettings:\n");
444 seq_printf(m
, "\tpacket size:\t\t%dkB\n", pd
->settings
.size
/ 2);
446 if (pd
->settings
.write_type
== 0)
450 seq_printf(m
, "\twrite type:\t\t%s\n", msg
);
452 seq_printf(m
, "\tpacket type:\t\t%s\n", pd
->settings
.fp
? "Fixed" : "Variable");
453 seq_printf(m
, "\tlink loss:\t\t%d\n", pd
->settings
.link_loss
);
455 seq_printf(m
, "\ttrack mode:\t\t%d\n", pd
->settings
.track_mode
);
457 if (pd
->settings
.block_mode
== PACKET_BLOCK_MODE1
)
459 else if (pd
->settings
.block_mode
== PACKET_BLOCK_MODE2
)
463 seq_printf(m
, "\tblock mode:\t\t%s\n", msg
);
465 seq_printf(m
, "\nStatistics:\n");
466 seq_printf(m
, "\tpackets started:\t%lu\n", pd
->stats
.pkt_started
);
467 seq_printf(m
, "\tpackets ended:\t\t%lu\n", pd
->stats
.pkt_ended
);
468 seq_printf(m
, "\twritten:\t\t%lukB\n", pd
->stats
.secs_w
>> 1);
469 seq_printf(m
, "\tread gather:\t\t%lukB\n", pd
->stats
.secs_rg
>> 1);
470 seq_printf(m
, "\tread:\t\t\t%lukB\n", pd
->stats
.secs_r
>> 1);
472 seq_printf(m
, "\nMisc:\n");
473 seq_printf(m
, "\treference count:\t%d\n", pd
->refcnt
);
474 seq_printf(m
, "\tflags:\t\t\t0x%lx\n", pd
->flags
);
475 seq_printf(m
, "\tread speed:\t\t%ukB/s\n", pd
->read_speed
);
476 seq_printf(m
, "\twrite speed:\t\t%ukB/s\n", pd
->write_speed
);
477 seq_printf(m
, "\tstart offset:\t\t%lu\n", pd
->offset
);
478 seq_printf(m
, "\tmode page offset:\t%u\n", pd
->mode_offset
);
480 seq_printf(m
, "\nQueue state:\n");
481 seq_printf(m
, "\tbios queued:\t\t%d\n", pd
->bio_queue_size
);
482 seq_printf(m
, "\tbios pending:\t\t%d\n", atomic_read(&pd
->cdrw
.pending_bios
));
483 seq_printf(m
, "\tcurrent sector:\t\t0x%llx\n", pd
->current_sector
);
485 pkt_count_states(pd
, states
);
486 seq_printf(m
, "\tstate:\t\t\ti:%d ow:%d rw:%d ww:%d rec:%d fin:%d\n",
487 states
[0], states
[1], states
[2], states
[3], states
[4], states
[5]);
489 seq_printf(m
, "\twrite congestion marks:\toff=%d on=%d\n",
490 pd
->write_congestion_off
,
491 pd
->write_congestion_on
);
494 DEFINE_SHOW_ATTRIBUTE(pkt_seq
);
496 static void pkt_debugfs_dev_new(struct pktcdvd_device
*pd
)
498 if (!pkt_debugfs_root
)
500 pd
->dfs_d_root
= debugfs_create_dir(pd
->disk
->disk_name
, pkt_debugfs_root
);
504 pd
->dfs_f_info
= debugfs_create_file("info", 0444, pd
->dfs_d_root
,
508 static void pkt_debugfs_dev_remove(struct pktcdvd_device
*pd
)
510 if (!pkt_debugfs_root
)
512 debugfs_remove(pd
->dfs_f_info
);
513 debugfs_remove(pd
->dfs_d_root
);
514 pd
->dfs_f_info
= NULL
;
515 pd
->dfs_d_root
= NULL
;
518 static void pkt_debugfs_init(void)
520 pkt_debugfs_root
= debugfs_create_dir(DRIVER_NAME
, NULL
);
523 static void pkt_debugfs_cleanup(void)
525 debugfs_remove(pkt_debugfs_root
);
526 pkt_debugfs_root
= NULL
;
529 /* ----------------------------------------------------------*/
532 static void pkt_bio_finished(struct pktcdvd_device
*pd
)
534 struct device
*ddev
= disk_to_dev(pd
->disk
);
536 BUG_ON(atomic_read(&pd
->cdrw
.pending_bios
) <= 0);
537 if (atomic_dec_and_test(&pd
->cdrw
.pending_bios
)) {
538 dev_dbg(ddev
, "queue empty\n");
539 atomic_set(&pd
->iosched
.attention
, 1);
540 wake_up(&pd
->wqueue
);
545 * Allocate a packet_data struct
547 static struct packet_data
*pkt_alloc_packet_data(int frames
)
550 struct packet_data
*pkt
;
552 pkt
= kzalloc(sizeof(struct packet_data
), GFP_KERNEL
);
556 pkt
->frames
= frames
;
557 pkt
->w_bio
= bio_kmalloc(frames
, GFP_KERNEL
);
561 for (i
= 0; i
< frames
/ FRAMES_PER_PAGE
; i
++) {
562 pkt
->pages
[i
] = alloc_page(GFP_KERNEL
|__GFP_ZERO
);
567 spin_lock_init(&pkt
->lock
);
568 bio_list_init(&pkt
->orig_bios
);
570 for (i
= 0; i
< frames
; i
++) {
571 pkt
->r_bios
[i
] = bio_kmalloc(1, GFP_KERNEL
);
579 for (i
= 0; i
< frames
; i
++)
580 kfree(pkt
->r_bios
[i
]);
582 for (i
= 0; i
< frames
/ FRAMES_PER_PAGE
; i
++)
584 __free_page(pkt
->pages
[i
]);
593 * Free a packet_data struct
595 static void pkt_free_packet_data(struct packet_data
*pkt
)
599 for (i
= 0; i
< pkt
->frames
; i
++)
600 kfree(pkt
->r_bios
[i
]);
601 for (i
= 0; i
< pkt
->frames
/ FRAMES_PER_PAGE
; i
++)
602 __free_page(pkt
->pages
[i
]);
607 static void pkt_shrink_pktlist(struct pktcdvd_device
*pd
)
609 struct packet_data
*pkt
, *next
;
611 BUG_ON(!list_empty(&pd
->cdrw
.pkt_active_list
));
613 list_for_each_entry_safe(pkt
, next
, &pd
->cdrw
.pkt_free_list
, list
) {
614 pkt_free_packet_data(pkt
);
616 INIT_LIST_HEAD(&pd
->cdrw
.pkt_free_list
);
619 static int pkt_grow_pktlist(struct pktcdvd_device
*pd
, int nr_packets
)
621 struct packet_data
*pkt
;
623 BUG_ON(!list_empty(&pd
->cdrw
.pkt_free_list
));
625 while (nr_packets
> 0) {
626 pkt
= pkt_alloc_packet_data(pd
->settings
.size
>> 2);
628 pkt_shrink_pktlist(pd
);
631 pkt
->id
= nr_packets
;
633 list_add(&pkt
->list
, &pd
->cdrw
.pkt_free_list
);
639 static inline struct pkt_rb_node
*pkt_rbtree_next(struct pkt_rb_node
*node
)
641 struct rb_node
*n
= rb_next(&node
->rb_node
);
644 return rb_entry(n
, struct pkt_rb_node
, rb_node
);
647 static void pkt_rbtree_erase(struct pktcdvd_device
*pd
, struct pkt_rb_node
*node
)
649 rb_erase(&node
->rb_node
, &pd
->bio_queue
);
650 mempool_free(node
, &pd
->rb_pool
);
651 pd
->bio_queue_size
--;
652 BUG_ON(pd
->bio_queue_size
< 0);
656 * Find the first node in the pd->bio_queue rb tree with a starting sector >= s.
658 static struct pkt_rb_node
*pkt_rbtree_find(struct pktcdvd_device
*pd
, sector_t s
)
660 struct rb_node
*n
= pd
->bio_queue
.rb_node
;
661 struct rb_node
*next
;
662 struct pkt_rb_node
*tmp
;
665 BUG_ON(pd
->bio_queue_size
> 0);
670 tmp
= rb_entry(n
, struct pkt_rb_node
, rb_node
);
671 if (s
<= tmp
->bio
->bi_iter
.bi_sector
)
680 if (s
> tmp
->bio
->bi_iter
.bi_sector
) {
681 tmp
= pkt_rbtree_next(tmp
);
685 BUG_ON(s
> tmp
->bio
->bi_iter
.bi_sector
);
690 * Insert a node into the pd->bio_queue rb tree.
692 static void pkt_rbtree_insert(struct pktcdvd_device
*pd
, struct pkt_rb_node
*node
)
694 struct rb_node
**p
= &pd
->bio_queue
.rb_node
;
695 struct rb_node
*parent
= NULL
;
696 sector_t s
= node
->bio
->bi_iter
.bi_sector
;
697 struct pkt_rb_node
*tmp
;
701 tmp
= rb_entry(parent
, struct pkt_rb_node
, rb_node
);
702 if (s
< tmp
->bio
->bi_iter
.bi_sector
)
707 rb_link_node(&node
->rb_node
, parent
, p
);
708 rb_insert_color(&node
->rb_node
, &pd
->bio_queue
);
709 pd
->bio_queue_size
++;
713 * Send a packet_command to the underlying block device and
714 * wait for completion.
716 static int pkt_generic_packet(struct pktcdvd_device
*pd
, struct packet_command
*cgc
)
718 struct request_queue
*q
= bdev_get_queue(file_bdev(pd
->bdev_file
));
719 struct scsi_cmnd
*scmd
;
723 rq
= scsi_alloc_request(q
, (cgc
->data_direction
== CGC_DATA_WRITE
) ?
724 REQ_OP_DRV_OUT
: REQ_OP_DRV_IN
, 0);
727 scmd
= blk_mq_rq_to_pdu(rq
);
730 ret
= blk_rq_map_kern(q
, rq
, cgc
->buffer
, cgc
->buflen
,
736 scmd
->cmd_len
= COMMAND_SIZE(cgc
->cmd
[0]);
737 memcpy(scmd
->cmnd
, cgc
->cmd
, CDROM_PACKET_SIZE
);
741 rq
->rq_flags
|= RQF_QUIET
;
743 blk_execute_rq(rq
, false);
747 blk_mq_free_request(rq
);
751 static const char *sense_key_string(__u8 index
)
753 static const char * const info
[] = {
754 "No sense", "Recovered error", "Not ready",
755 "Medium error", "Hardware error", "Illegal request",
756 "Unit attention", "Data protect", "Blank check",
759 return index
< ARRAY_SIZE(info
) ? info
[index
] : "INVALID";
763 * A generic sense dump / resolve mechanism should be implemented across
764 * all ATAPI + SCSI devices.
766 static void pkt_dump_sense(struct pktcdvd_device
*pd
,
767 struct packet_command
*cgc
)
769 struct device
*ddev
= disk_to_dev(pd
->disk
);
770 struct scsi_sense_hdr
*sshdr
= cgc
->sshdr
;
773 dev_err(ddev
, "%*ph - sense %02x.%02x.%02x (%s)\n",
774 CDROM_PACKET_SIZE
, cgc
->cmd
,
775 sshdr
->sense_key
, sshdr
->asc
, sshdr
->ascq
,
776 sense_key_string(sshdr
->sense_key
));
778 dev_err(ddev
, "%*ph - no sense\n", CDROM_PACKET_SIZE
, cgc
->cmd
);
782 * flush the drive cache to media
784 static int pkt_flush_cache(struct pktcdvd_device
*pd
)
786 struct packet_command cgc
;
788 init_cdrom_command(&cgc
, NULL
, 0, CGC_DATA_NONE
);
789 cgc
.cmd
[0] = GPCMD_FLUSH_CACHE
;
793 * the IMMED bit -- we default to not setting it, although that
794 * would allow a much faster close, this is safer
799 return pkt_generic_packet(pd
, &cgc
);
803 * speed is given as the normal factor, e.g. 4 for 4x
805 static noinline_for_stack
int pkt_set_speed(struct pktcdvd_device
*pd
,
806 unsigned write_speed
, unsigned read_speed
)
808 struct packet_command cgc
;
809 struct scsi_sense_hdr sshdr
;
812 init_cdrom_command(&cgc
, NULL
, 0, CGC_DATA_NONE
);
814 cgc
.cmd
[0] = GPCMD_SET_SPEED
;
815 put_unaligned_be16(read_speed
, &cgc
.cmd
[2]);
816 put_unaligned_be16(write_speed
, &cgc
.cmd
[4]);
818 ret
= pkt_generic_packet(pd
, &cgc
);
820 pkt_dump_sense(pd
, &cgc
);
826 * Queue a bio for processing by the low-level CD device. Must be called
827 * from process context.
829 static void pkt_queue_bio(struct pktcdvd_device
*pd
, struct bio
*bio
)
832 * Some CDRW drives can not handle writes larger than one packet,
833 * even if the size is a multiple of the packet size.
835 bio
->bi_opf
|= REQ_NOMERGE
;
837 spin_lock(&pd
->iosched
.lock
);
838 if (bio_data_dir(bio
) == READ
)
839 bio_list_add(&pd
->iosched
.read_queue
, bio
);
841 bio_list_add(&pd
->iosched
.write_queue
, bio
);
842 spin_unlock(&pd
->iosched
.lock
);
844 atomic_set(&pd
->iosched
.attention
, 1);
845 wake_up(&pd
->wqueue
);
849 * Process the queued read/write requests. This function handles special
850 * requirements for CDRW drives:
851 * - A cache flush command must be inserted before a read request if the
852 * previous request was a write.
853 * - Switching between reading and writing is slow, so don't do it more often
855 * - Optimize for throughput at the expense of latency. This means that streaming
856 * writes will never be interrupted by a read, but if the drive has to seek
857 * before the next write, switch to reading instead if there are any pending
859 * - Set the read speed according to current usage pattern. When only reading
860 * from the device, it's best to use the highest possible read speed, but
861 * when switching often between reading and writing, it's better to have the
862 * same read and write speeds.
864 static void pkt_iosched_process_queue(struct pktcdvd_device
*pd
)
866 struct device
*ddev
= disk_to_dev(pd
->disk
);
868 if (atomic_read(&pd
->iosched
.attention
) == 0)
870 atomic_set(&pd
->iosched
.attention
, 0);
874 int reads_queued
, writes_queued
;
876 spin_lock(&pd
->iosched
.lock
);
877 reads_queued
= !bio_list_empty(&pd
->iosched
.read_queue
);
878 writes_queued
= !bio_list_empty(&pd
->iosched
.write_queue
);
879 spin_unlock(&pd
->iosched
.lock
);
881 if (!reads_queued
&& !writes_queued
)
884 if (pd
->iosched
.writing
) {
885 int need_write_seek
= 1;
886 spin_lock(&pd
->iosched
.lock
);
887 bio
= bio_list_peek(&pd
->iosched
.write_queue
);
888 spin_unlock(&pd
->iosched
.lock
);
889 if (bio
&& (bio
->bi_iter
.bi_sector
==
890 pd
->iosched
.last_write
))
892 if (need_write_seek
&& reads_queued
) {
893 if (atomic_read(&pd
->cdrw
.pending_bios
) > 0) {
894 dev_dbg(ddev
, "write, waiting\n");
898 pd
->iosched
.writing
= 0;
901 if (!reads_queued
&& writes_queued
) {
902 if (atomic_read(&pd
->cdrw
.pending_bios
) > 0) {
903 dev_dbg(ddev
, "read, waiting\n");
906 pd
->iosched
.writing
= 1;
910 spin_lock(&pd
->iosched
.lock
);
911 if (pd
->iosched
.writing
)
912 bio
= bio_list_pop(&pd
->iosched
.write_queue
);
914 bio
= bio_list_pop(&pd
->iosched
.read_queue
);
915 spin_unlock(&pd
->iosched
.lock
);
920 if (bio_data_dir(bio
) == READ
)
921 pd
->iosched
.successive_reads
+=
922 bio
->bi_iter
.bi_size
>> 10;
924 pd
->iosched
.successive_reads
= 0;
925 pd
->iosched
.last_write
= bio_end_sector(bio
);
927 if (pd
->iosched
.successive_reads
>= HI_SPEED_SWITCH
) {
928 if (pd
->read_speed
== pd
->write_speed
) {
929 pd
->read_speed
= MAX_SPEED
;
930 pkt_set_speed(pd
, pd
->write_speed
, pd
->read_speed
);
933 if (pd
->read_speed
!= pd
->write_speed
) {
934 pd
->read_speed
= pd
->write_speed
;
935 pkt_set_speed(pd
, pd
->write_speed
, pd
->read_speed
);
939 atomic_inc(&pd
->cdrw
.pending_bios
);
940 submit_bio_noacct(bio
);
945 * Special care is needed if the underlying block device has a small
946 * max_phys_segments value.
948 static int pkt_set_segment_merging(struct pktcdvd_device
*pd
, struct request_queue
*q
)
950 struct device
*ddev
= disk_to_dev(pd
->disk
);
952 if ((pd
->settings
.size
<< 9) / CD_FRAMESIZE
<= queue_max_segments(q
)) {
954 * The cdrom device can handle one segment/frame
956 clear_bit(PACKET_MERGE_SEGS
, &pd
->flags
);
960 if ((pd
->settings
.size
<< 9) / PAGE_SIZE
<= queue_max_segments(q
)) {
962 * We can handle this case at the expense of some extra memory
963 * copies during write operations
965 set_bit(PACKET_MERGE_SEGS
, &pd
->flags
);
969 dev_err(ddev
, "cdrom max_phys_segments too small\n");
973 static void pkt_end_io_read(struct bio
*bio
)
975 struct packet_data
*pkt
= bio
->bi_private
;
976 struct pktcdvd_device
*pd
= pkt
->pd
;
979 dev_dbg(disk_to_dev(pd
->disk
), "bio=%p sec0=%llx sec=%llx err=%d\n",
980 bio
, pkt
->sector
, bio
->bi_iter
.bi_sector
, bio
->bi_status
);
983 atomic_inc(&pkt
->io_errors
);
985 if (atomic_dec_and_test(&pkt
->io_wait
)) {
986 atomic_inc(&pkt
->run_sm
);
987 wake_up(&pd
->wqueue
);
989 pkt_bio_finished(pd
);
992 static void pkt_end_io_packet_write(struct bio
*bio
)
994 struct packet_data
*pkt
= bio
->bi_private
;
995 struct pktcdvd_device
*pd
= pkt
->pd
;
998 dev_dbg(disk_to_dev(pd
->disk
), "id=%d, err=%d\n", pkt
->id
, bio
->bi_status
);
1000 pd
->stats
.pkt_ended
++;
1003 pkt_bio_finished(pd
);
1004 atomic_dec(&pkt
->io_wait
);
1005 atomic_inc(&pkt
->run_sm
);
1006 wake_up(&pd
->wqueue
);
1010 * Schedule reads for the holes in a packet
1012 static void pkt_gather_data(struct pktcdvd_device
*pd
, struct packet_data
*pkt
)
1014 struct device
*ddev
= disk_to_dev(pd
->disk
);
1015 int frames_read
= 0;
1018 char written
[PACKET_MAX_SIZE
];
1020 BUG_ON(bio_list_empty(&pkt
->orig_bios
));
1022 atomic_set(&pkt
->io_wait
, 0);
1023 atomic_set(&pkt
->io_errors
, 0);
1026 * Figure out which frames we need to read before we can write.
1028 memset(written
, 0, sizeof(written
));
1029 spin_lock(&pkt
->lock
);
1030 bio_list_for_each(bio
, &pkt
->orig_bios
) {
1031 int first_frame
= (bio
->bi_iter
.bi_sector
- pkt
->sector
) /
1032 (CD_FRAMESIZE
>> 9);
1033 int num_frames
= bio
->bi_iter
.bi_size
/ CD_FRAMESIZE
;
1034 pd
->stats
.secs_w
+= num_frames
* (CD_FRAMESIZE
>> 9);
1035 BUG_ON(first_frame
< 0);
1036 BUG_ON(first_frame
+ num_frames
> pkt
->frames
);
1037 for (f
= first_frame
; f
< first_frame
+ num_frames
; f
++)
1040 spin_unlock(&pkt
->lock
);
1042 if (pkt
->cache_valid
) {
1043 dev_dbg(ddev
, "zone %llx cached\n", pkt
->sector
);
1048 * Schedule reads for missing parts of the packet.
1050 for (f
= 0; f
< pkt
->frames
; f
++) {
1056 bio
= pkt
->r_bios
[f
];
1057 bio_init(bio
, file_bdev(pd
->bdev_file
), bio
->bi_inline_vecs
, 1,
1059 bio
->bi_iter
.bi_sector
= pkt
->sector
+ f
* (CD_FRAMESIZE
>> 9);
1060 bio
->bi_end_io
= pkt_end_io_read
;
1061 bio
->bi_private
= pkt
;
1063 p
= (f
* CD_FRAMESIZE
) / PAGE_SIZE
;
1064 offset
= (f
* CD_FRAMESIZE
) % PAGE_SIZE
;
1065 dev_dbg(ddev
, "Adding frame %d, page:%p offs:%d\n", f
,
1066 pkt
->pages
[p
], offset
);
1067 if (!bio_add_page(bio
, pkt
->pages
[p
], CD_FRAMESIZE
, offset
))
1070 atomic_inc(&pkt
->io_wait
);
1071 pkt_queue_bio(pd
, bio
);
1076 dev_dbg(ddev
, "need %d frames for zone %llx\n", frames_read
, pkt
->sector
);
1077 pd
->stats
.pkt_started
++;
1078 pd
->stats
.secs_rg
+= frames_read
* (CD_FRAMESIZE
>> 9);
1082 * Find a packet matching zone, or the least recently used packet if
1083 * there is no match.
1085 static struct packet_data
*pkt_get_packet_data(struct pktcdvd_device
*pd
, int zone
)
1087 struct packet_data
*pkt
;
1089 list_for_each_entry(pkt
, &pd
->cdrw
.pkt_free_list
, list
) {
1090 if (pkt
->sector
== zone
|| pkt
->list
.next
== &pd
->cdrw
.pkt_free_list
) {
1091 list_del_init(&pkt
->list
);
1092 if (pkt
->sector
!= zone
)
1093 pkt
->cache_valid
= 0;
1101 static void pkt_put_packet_data(struct pktcdvd_device
*pd
, struct packet_data
*pkt
)
1103 if (pkt
->cache_valid
) {
1104 list_add(&pkt
->list
, &pd
->cdrw
.pkt_free_list
);
1106 list_add_tail(&pkt
->list
, &pd
->cdrw
.pkt_free_list
);
1110 static inline void pkt_set_state(struct device
*ddev
, struct packet_data
*pkt
,
1111 enum packet_data_state state
)
1113 static const char *state_name
[] = {
1114 "IDLE", "WAITING", "READ_WAIT", "WRITE_WAIT", "RECOVERY", "FINISHED"
1116 enum packet_data_state old_state
= pkt
->state
;
1118 dev_dbg(ddev
, "pkt %2d : s=%6llx %s -> %s\n",
1119 pkt
->id
, pkt
->sector
, state_name
[old_state
], state_name
[state
]);
1125 * Scan the work queue to see if we can start a new packet.
1126 * returns non-zero if any work was done.
1128 static int pkt_handle_queue(struct pktcdvd_device
*pd
)
1130 struct device
*ddev
= disk_to_dev(pd
->disk
);
1131 struct packet_data
*pkt
, *p
;
1132 struct bio
*bio
= NULL
;
1133 sector_t zone
= 0; /* Suppress gcc warning */
1134 struct pkt_rb_node
*node
, *first_node
;
1137 atomic_set(&pd
->scan_queue
, 0);
1139 if (list_empty(&pd
->cdrw
.pkt_free_list
)) {
1140 dev_dbg(ddev
, "no pkt\n");
1145 * Try to find a zone we are not already working on.
1147 spin_lock(&pd
->lock
);
1148 first_node
= pkt_rbtree_find(pd
, pd
->current_sector
);
1150 n
= rb_first(&pd
->bio_queue
);
1152 first_node
= rb_entry(n
, struct pkt_rb_node
, rb_node
);
1157 zone
= get_zone(bio
->bi_iter
.bi_sector
, pd
);
1158 list_for_each_entry(p
, &pd
->cdrw
.pkt_active_list
, list
) {
1159 if (p
->sector
== zone
) {
1166 node
= pkt_rbtree_next(node
);
1168 n
= rb_first(&pd
->bio_queue
);
1170 node
= rb_entry(n
, struct pkt_rb_node
, rb_node
);
1172 if (node
== first_node
)
1175 spin_unlock(&pd
->lock
);
1177 dev_dbg(ddev
, "no bio\n");
1181 pkt
= pkt_get_packet_data(pd
, zone
);
1183 pd
->current_sector
= zone
+ pd
->settings
.size
;
1185 BUG_ON(pkt
->frames
!= pd
->settings
.size
>> 2);
1186 pkt
->write_size
= 0;
1189 * Scan work queue for bios in the same zone and link them
1192 spin_lock(&pd
->lock
);
1193 dev_dbg(ddev
, "looking for zone %llx\n", zone
);
1194 while ((node
= pkt_rbtree_find(pd
, zone
)) != NULL
) {
1195 sector_t tmp
= get_zone(node
->bio
->bi_iter
.bi_sector
, pd
);
1198 dev_dbg(ddev
, "found zone=%llx\n", tmp
);
1201 pkt_rbtree_erase(pd
, node
);
1202 spin_lock(&pkt
->lock
);
1203 bio_list_add(&pkt
->orig_bios
, bio
);
1204 pkt
->write_size
+= bio
->bi_iter
.bi_size
/ CD_FRAMESIZE
;
1205 spin_unlock(&pkt
->lock
);
1207 /* check write congestion marks, and if bio_queue_size is
1208 * below, wake up any waiters
1210 if (pd
->congested
&&
1211 pd
->bio_queue_size
<= pd
->write_congestion_off
) {
1212 pd
->congested
= false;
1213 wake_up_var(&pd
->congested
);
1215 spin_unlock(&pd
->lock
);
1217 pkt
->sleep_time
= max(PACKET_WAIT_TIME
, 1);
1218 pkt_set_state(ddev
, pkt
, PACKET_WAITING_STATE
);
1219 atomic_set(&pkt
->run_sm
, 1);
1221 spin_lock(&pd
->cdrw
.active_list_lock
);
1222 list_add(&pkt
->list
, &pd
->cdrw
.pkt_active_list
);
1223 spin_unlock(&pd
->cdrw
.active_list_lock
);
1229 * bio_list_copy_data - copy contents of data buffers from one chain of bios to
1231 * @src: source bio list
1232 * @dst: destination bio list
1234 * Stops when it reaches the end of either the @src list or @dst list - that is,
1235 * copies min(src->bi_size, dst->bi_size) bytes (or the equivalent for lists of
1238 static void bio_list_copy_data(struct bio
*dst
, struct bio
*src
)
1240 struct bvec_iter src_iter
= src
->bi_iter
;
1241 struct bvec_iter dst_iter
= dst
->bi_iter
;
1244 if (!src_iter
.bi_size
) {
1249 src_iter
= src
->bi_iter
;
1252 if (!dst_iter
.bi_size
) {
1257 dst_iter
= dst
->bi_iter
;
1260 bio_copy_data_iter(dst
, &dst_iter
, src
, &src_iter
);
1265 * Assemble a bio to write one packet and queue the bio for processing
1266 * by the underlying block device.
1268 static void pkt_start_write(struct pktcdvd_device
*pd
, struct packet_data
*pkt
)
1270 struct device
*ddev
= disk_to_dev(pd
->disk
);
1273 bio_init(pkt
->w_bio
, file_bdev(pd
->bdev_file
), pkt
->w_bio
->bi_inline_vecs
,
1274 pkt
->frames
, REQ_OP_WRITE
);
1275 pkt
->w_bio
->bi_iter
.bi_sector
= pkt
->sector
;
1276 pkt
->w_bio
->bi_end_io
= pkt_end_io_packet_write
;
1277 pkt
->w_bio
->bi_private
= pkt
;
1280 for (f
= 0; f
< pkt
->frames
; f
++) {
1281 struct page
*page
= pkt
->pages
[(f
* CD_FRAMESIZE
) / PAGE_SIZE
];
1282 unsigned offset
= (f
* CD_FRAMESIZE
) % PAGE_SIZE
;
1284 if (!bio_add_page(pkt
->w_bio
, page
, CD_FRAMESIZE
, offset
))
1287 dev_dbg(ddev
, "vcnt=%d\n", pkt
->w_bio
->bi_vcnt
);
1290 * Fill-in bvec with data from orig_bios.
1292 spin_lock(&pkt
->lock
);
1293 bio_list_copy_data(pkt
->w_bio
, pkt
->orig_bios
.head
);
1295 pkt_set_state(ddev
, pkt
, PACKET_WRITE_WAIT_STATE
);
1296 spin_unlock(&pkt
->lock
);
1298 dev_dbg(ddev
, "Writing %d frames for zone %llx\n", pkt
->write_size
, pkt
->sector
);
1300 if (test_bit(PACKET_MERGE_SEGS
, &pd
->flags
) || (pkt
->write_size
< pkt
->frames
))
1301 pkt
->cache_valid
= 1;
1303 pkt
->cache_valid
= 0;
1305 /* Start the write request */
1306 atomic_set(&pkt
->io_wait
, 1);
1307 pkt_queue_bio(pd
, pkt
->w_bio
);
1310 static void pkt_finish_packet(struct packet_data
*pkt
, blk_status_t status
)
1315 pkt
->cache_valid
= 0;
1317 /* Finish all bios corresponding to this packet */
1318 while ((bio
= bio_list_pop(&pkt
->orig_bios
))) {
1319 bio
->bi_status
= status
;
1324 static void pkt_run_state_machine(struct pktcdvd_device
*pd
, struct packet_data
*pkt
)
1326 struct device
*ddev
= disk_to_dev(pd
->disk
);
1328 dev_dbg(ddev
, "pkt %d\n", pkt
->id
);
1331 switch (pkt
->state
) {
1332 case PACKET_WAITING_STATE
:
1333 if ((pkt
->write_size
< pkt
->frames
) && (pkt
->sleep_time
> 0))
1336 pkt
->sleep_time
= 0;
1337 pkt_gather_data(pd
, pkt
);
1338 pkt_set_state(ddev
, pkt
, PACKET_READ_WAIT_STATE
);
1341 case PACKET_READ_WAIT_STATE
:
1342 if (atomic_read(&pkt
->io_wait
) > 0)
1345 if (atomic_read(&pkt
->io_errors
) > 0) {
1346 pkt_set_state(ddev
, pkt
, PACKET_RECOVERY_STATE
);
1348 pkt_start_write(pd
, pkt
);
1352 case PACKET_WRITE_WAIT_STATE
:
1353 if (atomic_read(&pkt
->io_wait
) > 0)
1356 if (!pkt
->w_bio
->bi_status
) {
1357 pkt_set_state(ddev
, pkt
, PACKET_FINISHED_STATE
);
1359 pkt_set_state(ddev
, pkt
, PACKET_RECOVERY_STATE
);
1363 case PACKET_RECOVERY_STATE
:
1364 dev_dbg(ddev
, "No recovery possible\n");
1365 pkt_set_state(ddev
, pkt
, PACKET_FINISHED_STATE
);
1368 case PACKET_FINISHED_STATE
:
1369 pkt_finish_packet(pkt
, pkt
->w_bio
->bi_status
);
1379 static void pkt_handle_packets(struct pktcdvd_device
*pd
)
1381 struct device
*ddev
= disk_to_dev(pd
->disk
);
1382 struct packet_data
*pkt
, *next
;
1385 * Run state machine for active packets
1387 list_for_each_entry(pkt
, &pd
->cdrw
.pkt_active_list
, list
) {
1388 if (atomic_read(&pkt
->run_sm
) > 0) {
1389 atomic_set(&pkt
->run_sm
, 0);
1390 pkt_run_state_machine(pd
, pkt
);
1395 * Move no longer active packets to the free list
1397 spin_lock(&pd
->cdrw
.active_list_lock
);
1398 list_for_each_entry_safe(pkt
, next
, &pd
->cdrw
.pkt_active_list
, list
) {
1399 if (pkt
->state
== PACKET_FINISHED_STATE
) {
1400 list_del(&pkt
->list
);
1401 pkt_put_packet_data(pd
, pkt
);
1402 pkt_set_state(ddev
, pkt
, PACKET_IDLE_STATE
);
1403 atomic_set(&pd
->scan_queue
, 1);
1406 spin_unlock(&pd
->cdrw
.active_list_lock
);
1410 * kcdrwd is woken up when writes have been queued for one of our
1411 * registered devices
1413 static int kcdrwd(void *foobar
)
1415 struct pktcdvd_device
*pd
= foobar
;
1416 struct device
*ddev
= disk_to_dev(pd
->disk
);
1417 struct packet_data
*pkt
;
1418 int states
[PACKET_NUM_STATES
];
1419 long min_sleep_time
, residue
;
1421 set_user_nice(current
, MIN_NICE
);
1425 DECLARE_WAITQUEUE(wait
, current
);
1428 * Wait until there is something to do
1430 add_wait_queue(&pd
->wqueue
, &wait
);
1432 set_current_state(TASK_INTERRUPTIBLE
);
1434 /* Check if we need to run pkt_handle_queue */
1435 if (atomic_read(&pd
->scan_queue
) > 0)
1438 /* Check if we need to run the state machine for some packet */
1439 list_for_each_entry(pkt
, &pd
->cdrw
.pkt_active_list
, list
) {
1440 if (atomic_read(&pkt
->run_sm
) > 0)
1444 /* Check if we need to process the iosched queues */
1445 if (atomic_read(&pd
->iosched
.attention
) != 0)
1448 /* Otherwise, go to sleep */
1449 pkt_count_states(pd
, states
);
1450 dev_dbg(ddev
, "i:%d ow:%d rw:%d ww:%d rec:%d fin:%d\n",
1451 states
[0], states
[1], states
[2], states
[3], states
[4], states
[5]);
1453 min_sleep_time
= MAX_SCHEDULE_TIMEOUT
;
1454 list_for_each_entry(pkt
, &pd
->cdrw
.pkt_active_list
, list
) {
1455 if (pkt
->sleep_time
&& pkt
->sleep_time
< min_sleep_time
)
1456 min_sleep_time
= pkt
->sleep_time
;
1459 dev_dbg(ddev
, "sleeping\n");
1460 residue
= schedule_timeout(min_sleep_time
);
1461 dev_dbg(ddev
, "wake up\n");
1463 /* make swsusp happy with our thread */
1466 list_for_each_entry(pkt
, &pd
->cdrw
.pkt_active_list
, list
) {
1467 if (!pkt
->sleep_time
)
1469 pkt
->sleep_time
-= min_sleep_time
- residue
;
1470 if (pkt
->sleep_time
<= 0) {
1471 pkt
->sleep_time
= 0;
1472 atomic_inc(&pkt
->run_sm
);
1476 if (kthread_should_stop())
1480 set_current_state(TASK_RUNNING
);
1481 remove_wait_queue(&pd
->wqueue
, &wait
);
1483 if (kthread_should_stop())
1487 * if pkt_handle_queue returns true, we can queue
1490 while (pkt_handle_queue(pd
))
1494 * Handle packet state machine
1496 pkt_handle_packets(pd
);
1499 * Handle iosched queues
1501 pkt_iosched_process_queue(pd
);
1507 static void pkt_print_settings(struct pktcdvd_device
*pd
)
1509 dev_info(disk_to_dev(pd
->disk
), "%s packets, %u blocks, Mode-%c disc\n",
1510 pd
->settings
.fp
? "Fixed" : "Variable",
1511 pd
->settings
.size
>> 2,
1512 pd
->settings
.block_mode
== 8 ? '1' : '2');
1515 static int pkt_mode_sense(struct pktcdvd_device
*pd
, struct packet_command
*cgc
, int page_code
, int page_control
)
1517 memset(cgc
->cmd
, 0, sizeof(cgc
->cmd
));
1519 cgc
->cmd
[0] = GPCMD_MODE_SENSE_10
;
1520 cgc
->cmd
[2] = page_code
| (page_control
<< 6);
1521 put_unaligned_be16(cgc
->buflen
, &cgc
->cmd
[7]);
1522 cgc
->data_direction
= CGC_DATA_READ
;
1523 return pkt_generic_packet(pd
, cgc
);
1526 static int pkt_mode_select(struct pktcdvd_device
*pd
, struct packet_command
*cgc
)
1528 memset(cgc
->cmd
, 0, sizeof(cgc
->cmd
));
1529 memset(cgc
->buffer
, 0, 2);
1530 cgc
->cmd
[0] = GPCMD_MODE_SELECT_10
;
1531 cgc
->cmd
[1] = 0x10; /* PF */
1532 put_unaligned_be16(cgc
->buflen
, &cgc
->cmd
[7]);
1533 cgc
->data_direction
= CGC_DATA_WRITE
;
1534 return pkt_generic_packet(pd
, cgc
);
1537 static int pkt_get_disc_info(struct pktcdvd_device
*pd
, disc_information
*di
)
1539 struct packet_command cgc
;
1542 /* set up command and get the disc info */
1543 init_cdrom_command(&cgc
, di
, sizeof(*di
), CGC_DATA_READ
);
1544 cgc
.cmd
[0] = GPCMD_READ_DISC_INFO
;
1545 cgc
.cmd
[8] = cgc
.buflen
= 2;
1548 ret
= pkt_generic_packet(pd
, &cgc
);
1552 /* not all drives have the same disc_info length, so requeue
1553 * packet with the length the drive tells us it can supply
1555 cgc
.buflen
= be16_to_cpu(di
->disc_information_length
) +
1556 sizeof(di
->disc_information_length
);
1558 if (cgc
.buflen
> sizeof(disc_information
))
1559 cgc
.buflen
= sizeof(disc_information
);
1561 cgc
.cmd
[8] = cgc
.buflen
;
1562 return pkt_generic_packet(pd
, &cgc
);
1565 static int pkt_get_track_info(struct pktcdvd_device
*pd
, __u16 track
, __u8 type
, track_information
*ti
)
1567 struct packet_command cgc
;
1570 init_cdrom_command(&cgc
, ti
, 8, CGC_DATA_READ
);
1571 cgc
.cmd
[0] = GPCMD_READ_TRACK_RZONE_INFO
;
1572 cgc
.cmd
[1] = type
& 3;
1573 put_unaligned_be16(track
, &cgc
.cmd
[4]);
1577 ret
= pkt_generic_packet(pd
, &cgc
);
1581 cgc
.buflen
= be16_to_cpu(ti
->track_information_length
) +
1582 sizeof(ti
->track_information_length
);
1584 if (cgc
.buflen
> sizeof(track_information
))
1585 cgc
.buflen
= sizeof(track_information
);
1587 cgc
.cmd
[8] = cgc
.buflen
;
1588 return pkt_generic_packet(pd
, &cgc
);
1591 static noinline_for_stack
int pkt_get_last_written(struct pktcdvd_device
*pd
,
1594 disc_information di
;
1595 track_information ti
;
1599 ret
= pkt_get_disc_info(pd
, &di
);
1603 last_track
= (di
.last_track_msb
<< 8) | di
.last_track_lsb
;
1604 ret
= pkt_get_track_info(pd
, last_track
, 1, &ti
);
1608 /* if this track is blank, try the previous. */
1611 ret
= pkt_get_track_info(pd
, last_track
, 1, &ti
);
1616 /* if last recorded field is valid, return it. */
1618 *last_written
= be32_to_cpu(ti
.last_rec_address
);
1620 /* make it up instead */
1621 *last_written
= be32_to_cpu(ti
.track_start
) +
1622 be32_to_cpu(ti
.track_size
);
1624 *last_written
-= (be32_to_cpu(ti
.free_blocks
) + 7);
1630 * write mode select package based on pd->settings
1632 static noinline_for_stack
int pkt_set_write_settings(struct pktcdvd_device
*pd
)
1634 struct device
*ddev
= disk_to_dev(pd
->disk
);
1635 struct packet_command cgc
;
1636 struct scsi_sense_hdr sshdr
;
1637 write_param_page
*wp
;
1641 /* doesn't apply to DVD+RW or DVD-RAM */
1642 if ((pd
->mmc3_profile
== 0x1a) || (pd
->mmc3_profile
== 0x12))
1645 memset(buffer
, 0, sizeof(buffer
));
1646 init_cdrom_command(&cgc
, buffer
, sizeof(*wp
), CGC_DATA_READ
);
1648 ret
= pkt_mode_sense(pd
, &cgc
, GPMODE_WRITE_PARMS_PAGE
, 0);
1650 pkt_dump_sense(pd
, &cgc
);
1654 size
= 2 + get_unaligned_be16(&buffer
[0]);
1655 pd
->mode_offset
= get_unaligned_be16(&buffer
[6]);
1656 if (size
> sizeof(buffer
))
1657 size
= sizeof(buffer
);
1662 init_cdrom_command(&cgc
, buffer
, size
, CGC_DATA_READ
);
1664 ret
= pkt_mode_sense(pd
, &cgc
, GPMODE_WRITE_PARMS_PAGE
, 0);
1666 pkt_dump_sense(pd
, &cgc
);
1671 * write page is offset header + block descriptor length
1673 wp
= (write_param_page
*) &buffer
[sizeof(struct mode_page_header
) + pd
->mode_offset
];
1675 wp
->fp
= pd
->settings
.fp
;
1676 wp
->track_mode
= pd
->settings
.track_mode
;
1677 wp
->write_type
= pd
->settings
.write_type
;
1678 wp
->data_block_type
= pd
->settings
.block_mode
;
1680 wp
->multi_session
= 0;
1682 #ifdef PACKET_USE_LS
1687 if (wp
->data_block_type
== PACKET_BLOCK_MODE1
) {
1688 wp
->session_format
= 0;
1690 } else if (wp
->data_block_type
== PACKET_BLOCK_MODE2
) {
1691 wp
->session_format
= 0x20;
1695 memcpy(&wp
->mcn
[1], PACKET_MCN
, sizeof(wp
->mcn
) - 1);
1701 dev_err(ddev
, "write mode wrong %d\n", wp
->data_block_type
);
1704 wp
->packet_size
= cpu_to_be32(pd
->settings
.size
>> 2);
1706 cgc
.buflen
= cgc
.cmd
[8] = size
;
1707 ret
= pkt_mode_select(pd
, &cgc
);
1709 pkt_dump_sense(pd
, &cgc
);
1713 pkt_print_settings(pd
);
1718 * 1 -- we can write to this track, 0 -- we can't
1720 static int pkt_writable_track(struct pktcdvd_device
*pd
, track_information
*ti
)
1722 struct device
*ddev
= disk_to_dev(pd
->disk
);
1724 switch (pd
->mmc3_profile
) {
1725 case 0x1a: /* DVD+RW */
1726 case 0x12: /* DVD-RAM */
1727 /* The track is always writable on DVD+RW/DVD-RAM */
1733 if (!ti
->packet
|| !ti
->fp
)
1737 * "good" settings as per Mt Fuji.
1739 if (ti
->rt
== 0 && ti
->blank
== 0)
1742 if (ti
->rt
== 0 && ti
->blank
== 1)
1745 if (ti
->rt
== 1 && ti
->blank
== 0)
1748 dev_err(ddev
, "bad state %d-%d-%d\n", ti
->rt
, ti
->blank
, ti
->packet
);
1753 * 1 -- we can write to this disc, 0 -- we can't
1755 static int pkt_writable_disc(struct pktcdvd_device
*pd
, disc_information
*di
)
1757 struct device
*ddev
= disk_to_dev(pd
->disk
);
1759 switch (pd
->mmc3_profile
) {
1760 case 0x0a: /* CD-RW */
1761 case 0xffff: /* MMC3 not supported */
1763 case 0x1a: /* DVD+RW */
1764 case 0x13: /* DVD-RW */
1765 case 0x12: /* DVD-RAM */
1768 dev_dbg(ddev
, "Wrong disc profile (%x)\n", pd
->mmc3_profile
);
1773 * for disc type 0xff we should probably reserve a new track.
1774 * but i'm not sure, should we leave this to user apps? probably.
1776 if (di
->disc_type
== 0xff) {
1777 dev_notice(ddev
, "unknown disc - no track?\n");
1781 if (di
->disc_type
!= 0x20 && di
->disc_type
!= 0) {
1782 dev_err(ddev
, "wrong disc type (%x)\n", di
->disc_type
);
1786 if (di
->erasable
== 0) {
1787 dev_err(ddev
, "disc not erasable\n");
1791 if (di
->border_status
== PACKET_SESSION_RESERVED
) {
1792 dev_err(ddev
, "can't write to last track (reserved)\n");
1799 static noinline_for_stack
int pkt_probe_settings(struct pktcdvd_device
*pd
)
1801 struct device
*ddev
= disk_to_dev(pd
->disk
);
1802 struct packet_command cgc
;
1803 unsigned char buf
[12];
1804 disc_information di
;
1805 track_information ti
;
1808 init_cdrom_command(&cgc
, buf
, sizeof(buf
), CGC_DATA_READ
);
1809 cgc
.cmd
[0] = GPCMD_GET_CONFIGURATION
;
1811 ret
= pkt_generic_packet(pd
, &cgc
);
1812 pd
->mmc3_profile
= ret
? 0xffff : get_unaligned_be16(&buf
[6]);
1814 memset(&di
, 0, sizeof(disc_information
));
1815 memset(&ti
, 0, sizeof(track_information
));
1817 ret
= pkt_get_disc_info(pd
, &di
);
1819 dev_err(ddev
, "failed get_disc\n");
1823 if (!pkt_writable_disc(pd
, &di
))
1826 pd
->type
= di
.erasable
? PACKET_CDRW
: PACKET_CDR
;
1828 track
= 1; /* (di.last_track_msb << 8) | di.last_track_lsb; */
1829 ret
= pkt_get_track_info(pd
, track
, 1, &ti
);
1831 dev_err(ddev
, "failed get_track\n");
1835 if (!pkt_writable_track(pd
, &ti
)) {
1836 dev_err(ddev
, "can't write to this track\n");
1841 * we keep packet size in 512 byte units, makes it easier to
1842 * deal with request calculations.
1844 pd
->settings
.size
= be32_to_cpu(ti
.fixed_packet_size
) << 2;
1845 if (pd
->settings
.size
== 0) {
1846 dev_notice(ddev
, "detected zero packet size!\n");
1849 if (pd
->settings
.size
> PACKET_MAX_SECTORS
) {
1850 dev_err(ddev
, "packet size is too big\n");
1853 pd
->settings
.fp
= ti
.fp
;
1854 pd
->offset
= (be32_to_cpu(ti
.track_start
) << 2) & (pd
->settings
.size
- 1);
1857 pd
->nwa
= be32_to_cpu(ti
.next_writable
);
1858 set_bit(PACKET_NWA_VALID
, &pd
->flags
);
1862 * in theory we could use lra on -RW media as well and just zero
1863 * blocks that haven't been written yet, but in practice that
1864 * is just a no-go. we'll use that for -R, naturally.
1867 pd
->lra
= be32_to_cpu(ti
.last_rec_address
);
1868 set_bit(PACKET_LRA_VALID
, &pd
->flags
);
1870 pd
->lra
= 0xffffffff;
1871 set_bit(PACKET_LRA_VALID
, &pd
->flags
);
1877 pd
->settings
.link_loss
= 7;
1878 pd
->settings
.write_type
= 0; /* packet */
1879 pd
->settings
.track_mode
= ti
.track_mode
;
1882 * mode1 or mode2 disc
1884 switch (ti
.data_mode
) {
1886 pd
->settings
.block_mode
= PACKET_BLOCK_MODE1
;
1889 pd
->settings
.block_mode
= PACKET_BLOCK_MODE2
;
1892 dev_err(ddev
, "unknown data mode\n");
1899 * enable/disable write caching on drive
1901 static noinline_for_stack
int pkt_write_caching(struct pktcdvd_device
*pd
)
1903 struct device
*ddev
= disk_to_dev(pd
->disk
);
1904 struct packet_command cgc
;
1905 struct scsi_sense_hdr sshdr
;
1906 unsigned char buf
[64];
1907 bool set
= IS_ENABLED(CONFIG_CDROM_PKTCDVD_WCACHE
);
1910 init_cdrom_command(&cgc
, buf
, sizeof(buf
), CGC_DATA_READ
);
1912 cgc
.buflen
= pd
->mode_offset
+ 12;
1915 * caching mode page might not be there, so quiet this command
1919 ret
= pkt_mode_sense(pd
, &cgc
, GPMODE_WCACHING_PAGE
, 0);
1924 * use drive write caching -- we need deferred error handling to be
1925 * able to successfully recover with this option (drive will return good
1926 * status as soon as the cdb is validated).
1928 buf
[pd
->mode_offset
+ 10] |= (set
<< 2);
1930 cgc
.buflen
= cgc
.cmd
[8] = 2 + get_unaligned_be16(&buf
[0]);
1931 ret
= pkt_mode_select(pd
, &cgc
);
1933 dev_err(ddev
, "write caching control failed\n");
1934 pkt_dump_sense(pd
, &cgc
);
1935 } else if (!ret
&& set
)
1936 dev_notice(ddev
, "enabled write caching\n");
1940 static int pkt_lock_door(struct pktcdvd_device
*pd
, int lockflag
)
1942 struct packet_command cgc
;
1944 init_cdrom_command(&cgc
, NULL
, 0, CGC_DATA_NONE
);
1945 cgc
.cmd
[0] = GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL
;
1946 cgc
.cmd
[4] = lockflag
? 1 : 0;
1947 return pkt_generic_packet(pd
, &cgc
);
1951 * Returns drive maximum write speed
1953 static noinline_for_stack
int pkt_get_max_speed(struct pktcdvd_device
*pd
,
1954 unsigned *write_speed
)
1956 struct packet_command cgc
;
1957 struct scsi_sense_hdr sshdr
;
1958 unsigned char buf
[256+18];
1959 unsigned char *cap_buf
;
1962 cap_buf
= &buf
[sizeof(struct mode_page_header
) + pd
->mode_offset
];
1963 init_cdrom_command(&cgc
, buf
, sizeof(buf
), CGC_DATA_UNKNOWN
);
1966 ret
= pkt_mode_sense(pd
, &cgc
, GPMODE_CAPABILITIES_PAGE
, 0);
1968 cgc
.buflen
= pd
->mode_offset
+ cap_buf
[1] + 2 +
1969 sizeof(struct mode_page_header
);
1970 ret
= pkt_mode_sense(pd
, &cgc
, GPMODE_CAPABILITIES_PAGE
, 0);
1972 pkt_dump_sense(pd
, &cgc
);
1977 offset
= 20; /* Obsoleted field, used by older drives */
1978 if (cap_buf
[1] >= 28)
1979 offset
= 28; /* Current write speed selected */
1980 if (cap_buf
[1] >= 30) {
1981 /* If the drive reports at least one "Logical Unit Write
1982 * Speed Performance Descriptor Block", use the information
1983 * in the first block. (contains the highest speed)
1985 int num_spdb
= get_unaligned_be16(&cap_buf
[30]);
1990 *write_speed
= get_unaligned_be16(&cap_buf
[offset
]);
1994 /* These tables from cdrecord - I don't have orange book */
1995 /* standard speed CD-RW (1-4x) */
1996 static char clv_to_speed
[16] = {
1997 /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */
1998 0, 2, 4, 6, 8, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
2000 /* high speed CD-RW (-10x) */
2001 static char hs_clv_to_speed
[16] = {
2002 /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */
2003 0, 2, 4, 6, 10, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
2005 /* ultra high speed CD-RW */
2006 static char us_clv_to_speed
[16] = {
2007 /* 0 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 */
2008 0, 2, 4, 8, 0, 0,16, 0,24,32,40,48, 0, 0, 0, 0
2012 * reads the maximum media speed from ATIP
2014 static noinline_for_stack
int pkt_media_speed(struct pktcdvd_device
*pd
,
2017 struct device
*ddev
= disk_to_dev(pd
->disk
);
2018 struct packet_command cgc
;
2019 struct scsi_sense_hdr sshdr
;
2020 unsigned char buf
[64];
2021 unsigned int size
, st
, sp
;
2024 init_cdrom_command(&cgc
, buf
, 2, CGC_DATA_READ
);
2026 cgc
.cmd
[0] = GPCMD_READ_TOC_PMA_ATIP
;
2028 cgc
.cmd
[2] = 4; /* READ ATIP */
2030 ret
= pkt_generic_packet(pd
, &cgc
);
2032 pkt_dump_sense(pd
, &cgc
);
2035 size
= 2 + get_unaligned_be16(&buf
[0]);
2036 if (size
> sizeof(buf
))
2039 init_cdrom_command(&cgc
, buf
, size
, CGC_DATA_READ
);
2041 cgc
.cmd
[0] = GPCMD_READ_TOC_PMA_ATIP
;
2045 ret
= pkt_generic_packet(pd
, &cgc
);
2047 pkt_dump_sense(pd
, &cgc
);
2051 if (!(buf
[6] & 0x40)) {
2052 dev_notice(ddev
, "disc type is not CD-RW\n");
2055 if (!(buf
[6] & 0x4)) {
2056 dev_notice(ddev
, "A1 values on media are not valid, maybe not CDRW?\n");
2060 st
= (buf
[6] >> 3) & 0x7; /* disc sub-type */
2062 sp
= buf
[16] & 0xf; /* max speed from ATIP A1 field */
2064 /* Info from cdrecord */
2066 case 0: /* standard speed */
2067 *speed
= clv_to_speed
[sp
];
2069 case 1: /* high speed */
2070 *speed
= hs_clv_to_speed
[sp
];
2072 case 2: /* ultra high speed */
2073 *speed
= us_clv_to_speed
[sp
];
2076 dev_notice(ddev
, "unknown disc sub-type %d\n", st
);
2080 dev_info(ddev
, "maximum media speed: %d\n", *speed
);
2083 dev_notice(ddev
, "unknown speed %d for sub-type %d\n", sp
, st
);
2088 static noinline_for_stack
int pkt_perform_opc(struct pktcdvd_device
*pd
)
2090 struct device
*ddev
= disk_to_dev(pd
->disk
);
2091 struct packet_command cgc
;
2092 struct scsi_sense_hdr sshdr
;
2095 dev_dbg(ddev
, "Performing OPC\n");
2097 init_cdrom_command(&cgc
, NULL
, 0, CGC_DATA_NONE
);
2099 cgc
.timeout
= 60*HZ
;
2100 cgc
.cmd
[0] = GPCMD_SEND_OPC
;
2102 ret
= pkt_generic_packet(pd
, &cgc
);
2104 pkt_dump_sense(pd
, &cgc
);
2108 static int pkt_open_write(struct pktcdvd_device
*pd
)
2110 struct device
*ddev
= disk_to_dev(pd
->disk
);
2112 unsigned int write_speed
, media_write_speed
, read_speed
;
2114 ret
= pkt_probe_settings(pd
);
2116 dev_dbg(ddev
, "failed probe\n");
2120 ret
= pkt_set_write_settings(pd
);
2122 dev_notice(ddev
, "failed saving write settings\n");
2126 pkt_write_caching(pd
);
2128 ret
= pkt_get_max_speed(pd
, &write_speed
);
2130 write_speed
= 16 * 177;
2131 switch (pd
->mmc3_profile
) {
2132 case 0x13: /* DVD-RW */
2133 case 0x1a: /* DVD+RW */
2134 case 0x12: /* DVD-RAM */
2135 dev_notice(ddev
, "write speed %ukB/s\n", write_speed
);
2138 ret
= pkt_media_speed(pd
, &media_write_speed
);
2140 media_write_speed
= 16;
2141 write_speed
= min(write_speed
, media_write_speed
* 177);
2142 dev_notice(ddev
, "write speed %ux\n", write_speed
/ 176);
2145 read_speed
= write_speed
;
2147 ret
= pkt_set_speed(pd
, write_speed
, read_speed
);
2149 dev_notice(ddev
, "couldn't set write speed\n");
2152 pd
->write_speed
= write_speed
;
2153 pd
->read_speed
= read_speed
;
2155 ret
= pkt_perform_opc(pd
);
2157 dev_notice(ddev
, "Optimum Power Calibration failed\n");
2163 * called at open time.
2165 static int pkt_open_dev(struct pktcdvd_device
*pd
, bool write
)
2167 struct device
*ddev
= disk_to_dev(pd
->disk
);
2170 struct request_queue
*q
;
2171 struct file
*bdev_file
;
2174 * We need to re-open the cdrom device without O_NONBLOCK to be able
2175 * to read/write from/to it. It is already opened in O_NONBLOCK mode
2176 * so open should not fail.
2178 bdev_file
= bdev_file_open_by_dev(file_bdev(pd
->bdev_file
)->bd_dev
,
2179 BLK_OPEN_READ
, pd
, NULL
);
2180 if (IS_ERR(bdev_file
)) {
2181 ret
= PTR_ERR(bdev_file
);
2184 pd
->f_open_bdev
= bdev_file
;
2186 ret
= pkt_get_last_written(pd
, &lba
);
2188 dev_err(ddev
, "pkt_get_last_written failed\n");
2192 set_capacity(pd
->disk
, lba
<< 2);
2193 set_capacity_and_notify(file_bdev(pd
->bdev_file
)->bd_disk
, lba
<< 2);
2195 q
= bdev_get_queue(file_bdev(pd
->bdev_file
));
2197 ret
= pkt_open_write(pd
);
2200 set_bit(PACKET_WRITABLE
, &pd
->flags
);
2202 pkt_set_speed(pd
, MAX_SPEED
, MAX_SPEED
);
2203 clear_bit(PACKET_WRITABLE
, &pd
->flags
);
2206 ret
= pkt_set_segment_merging(pd
, q
);
2211 if (!pkt_grow_pktlist(pd
, CONFIG_CDROM_PKTCDVD_BUFFERS
)) {
2212 dev_err(ddev
, "not enough memory for buffers\n");
2216 dev_info(ddev
, "%lukB available on disc\n", lba
<< 1);
2228 * called when the device is closed. makes sure that the device flushes
2229 * the internal cache before we close.
2231 static void pkt_release_dev(struct pktcdvd_device
*pd
, int flush
)
2233 struct device
*ddev
= disk_to_dev(pd
->disk
);
2235 if (flush
&& pkt_flush_cache(pd
))
2236 dev_notice(ddev
, "not flushing cache\n");
2238 pkt_lock_door(pd
, 0);
2240 pkt_set_speed(pd
, MAX_SPEED
, MAX_SPEED
);
2241 fput(pd
->f_open_bdev
);
2242 pd
->f_open_bdev
= NULL
;
2244 pkt_shrink_pktlist(pd
);
2247 static struct pktcdvd_device
*pkt_find_dev_from_minor(unsigned int dev_minor
)
2249 if (dev_minor
>= MAX_WRITERS
)
2252 dev_minor
= array_index_nospec(dev_minor
, MAX_WRITERS
);
2253 return pkt_devs
[dev_minor
];
2256 static int pkt_open(struct gendisk
*disk
, blk_mode_t mode
)
2258 struct pktcdvd_device
*pd
= NULL
;
2261 mutex_lock(&pktcdvd_mutex
);
2262 mutex_lock(&ctl_mutex
);
2263 pd
= pkt_find_dev_from_minor(disk
->first_minor
);
2268 BUG_ON(pd
->refcnt
< 0);
2271 if (pd
->refcnt
> 1) {
2272 if ((mode
& BLK_OPEN_WRITE
) &&
2273 !test_bit(PACKET_WRITABLE
, &pd
->flags
)) {
2278 ret
= pkt_open_dev(pd
, mode
& BLK_OPEN_WRITE
);
2282 * needed here as well, since ext2 (among others) may change
2283 * the blocksize at mount time
2285 set_blocksize(disk
->part0
, CD_FRAMESIZE
);
2287 mutex_unlock(&ctl_mutex
);
2288 mutex_unlock(&pktcdvd_mutex
);
2294 mutex_unlock(&ctl_mutex
);
2295 mutex_unlock(&pktcdvd_mutex
);
2299 static void pkt_release(struct gendisk
*disk
)
2301 struct pktcdvd_device
*pd
= disk
->private_data
;
2303 mutex_lock(&pktcdvd_mutex
);
2304 mutex_lock(&ctl_mutex
);
2306 BUG_ON(pd
->refcnt
< 0);
2307 if (pd
->refcnt
== 0) {
2308 int flush
= test_bit(PACKET_WRITABLE
, &pd
->flags
);
2309 pkt_release_dev(pd
, flush
);
2311 mutex_unlock(&ctl_mutex
);
2312 mutex_unlock(&pktcdvd_mutex
);
2316 static void pkt_end_io_read_cloned(struct bio
*bio
)
2318 struct packet_stacked_data
*psd
= bio
->bi_private
;
2319 struct pktcdvd_device
*pd
= psd
->pd
;
2321 psd
->bio
->bi_status
= bio
->bi_status
;
2323 bio_endio(psd
->bio
);
2324 mempool_free(psd
, &psd_pool
);
2325 pkt_bio_finished(pd
);
2328 static void pkt_make_request_read(struct pktcdvd_device
*pd
, struct bio
*bio
)
2330 struct bio
*cloned_bio
= bio_alloc_clone(file_bdev(pd
->bdev_file
), bio
,
2331 GFP_NOIO
, &pkt_bio_set
);
2332 struct packet_stacked_data
*psd
= mempool_alloc(&psd_pool
, GFP_NOIO
);
2336 cloned_bio
->bi_private
= psd
;
2337 cloned_bio
->bi_end_io
= pkt_end_io_read_cloned
;
2338 pd
->stats
.secs_r
+= bio_sectors(bio
);
2339 pkt_queue_bio(pd
, cloned_bio
);
2342 static void pkt_make_request_write(struct bio
*bio
)
2344 struct pktcdvd_device
*pd
= bio
->bi_bdev
->bd_disk
->private_data
;
2346 struct packet_data
*pkt
;
2347 int was_empty
, blocked_bio
;
2348 struct pkt_rb_node
*node
;
2350 zone
= get_zone(bio
->bi_iter
.bi_sector
, pd
);
2353 * If we find a matching packet in state WAITING or READ_WAIT, we can
2354 * just append this bio to that packet.
2356 spin_lock(&pd
->cdrw
.active_list_lock
);
2358 list_for_each_entry(pkt
, &pd
->cdrw
.pkt_active_list
, list
) {
2359 if (pkt
->sector
== zone
) {
2360 spin_lock(&pkt
->lock
);
2361 if ((pkt
->state
== PACKET_WAITING_STATE
) ||
2362 (pkt
->state
== PACKET_READ_WAIT_STATE
)) {
2363 bio_list_add(&pkt
->orig_bios
, bio
);
2365 bio
->bi_iter
.bi_size
/ CD_FRAMESIZE
;
2366 if ((pkt
->write_size
>= pkt
->frames
) &&
2367 (pkt
->state
== PACKET_WAITING_STATE
)) {
2368 atomic_inc(&pkt
->run_sm
);
2369 wake_up(&pd
->wqueue
);
2371 spin_unlock(&pkt
->lock
);
2372 spin_unlock(&pd
->cdrw
.active_list_lock
);
2377 spin_unlock(&pkt
->lock
);
2380 spin_unlock(&pd
->cdrw
.active_list_lock
);
2383 * Test if there is enough room left in the bio work queue
2384 * (queue size >= congestion on mark).
2385 * If not, wait till the work queue size is below the congestion off mark.
2387 spin_lock(&pd
->lock
);
2388 if (pd
->write_congestion_on
> 0
2389 && pd
->bio_queue_size
>= pd
->write_congestion_on
) {
2390 struct wait_bit_queue_entry wqe
;
2392 init_wait_var_entry(&wqe
, &pd
->congested
, 0);
2394 prepare_to_wait_event(__var_waitqueue(&pd
->congested
),
2396 TASK_UNINTERRUPTIBLE
);
2397 if (pd
->bio_queue_size
<= pd
->write_congestion_off
)
2399 pd
->congested
= true;
2400 spin_unlock(&pd
->lock
);
2402 spin_lock(&pd
->lock
);
2405 spin_unlock(&pd
->lock
);
2408 * No matching packet found. Store the bio in the work queue.
2410 node
= mempool_alloc(&pd
->rb_pool
, GFP_NOIO
);
2412 spin_lock(&pd
->lock
);
2413 BUG_ON(pd
->bio_queue_size
< 0);
2414 was_empty
= (pd
->bio_queue_size
== 0);
2415 pkt_rbtree_insert(pd
, node
);
2416 spin_unlock(&pd
->lock
);
2419 * Wake up the worker thread.
2421 atomic_set(&pd
->scan_queue
, 1);
2423 /* This wake_up is required for correct operation */
2424 wake_up(&pd
->wqueue
);
2425 } else if (!list_empty(&pd
->cdrw
.pkt_free_list
) && !blocked_bio
) {
2427 * This wake up is not required for correct operation,
2428 * but improves performance in some cases.
2430 wake_up(&pd
->wqueue
);
2434 static void pkt_submit_bio(struct bio
*bio
)
2436 struct pktcdvd_device
*pd
= bio
->bi_bdev
->bd_disk
->private_data
;
2437 struct device
*ddev
= disk_to_dev(pd
->disk
);
2440 bio
= bio_split_to_limits(bio
);
2444 dev_dbg(ddev
, "start = %6llx stop = %6llx\n",
2445 bio
->bi_iter
.bi_sector
, bio_end_sector(bio
));
2448 * Clone READ bios so we can have our own bi_end_io callback.
2450 if (bio_data_dir(bio
) == READ
) {
2451 pkt_make_request_read(pd
, bio
);
2455 if (!test_bit(PACKET_WRITABLE
, &pd
->flags
)) {
2456 dev_notice(ddev
, "WRITE for ro device (%llu)\n", bio
->bi_iter
.bi_sector
);
2460 if (!bio
->bi_iter
.bi_size
|| (bio
->bi_iter
.bi_size
% CD_FRAMESIZE
)) {
2461 dev_err(ddev
, "wrong bio size\n");
2466 sector_t zone
= get_zone(bio
->bi_iter
.bi_sector
, pd
);
2467 sector_t last_zone
= get_zone(bio_end_sector(bio
) - 1, pd
);
2469 if (last_zone
!= zone
) {
2470 BUG_ON(last_zone
!= zone
+ pd
->settings
.size
);
2472 split
= bio_split(bio
, last_zone
-
2473 bio
->bi_iter
.bi_sector
,
2474 GFP_NOIO
, &pkt_bio_set
);
2475 bio_chain(split
, bio
);
2480 pkt_make_request_write(split
);
2481 } while (split
!= bio
);
2488 static int pkt_new_dev(struct pktcdvd_device
*pd
, dev_t dev
)
2490 struct device
*ddev
= disk_to_dev(pd
->disk
);
2492 struct file
*bdev_file
;
2493 struct scsi_device
*sdev
;
2495 if (pd
->pkt_dev
== dev
) {
2496 dev_err(ddev
, "recursive setup not allowed\n");
2499 for (i
= 0; i
< MAX_WRITERS
; i
++) {
2500 struct pktcdvd_device
*pd2
= pkt_devs
[i
];
2503 if (file_bdev(pd2
->bdev_file
)->bd_dev
== dev
) {
2504 dev_err(ddev
, "%pg already setup\n",
2505 file_bdev(pd2
->bdev_file
));
2508 if (pd2
->pkt_dev
== dev
) {
2509 dev_err(ddev
, "can't chain pktcdvd devices\n");
2514 bdev_file
= bdev_file_open_by_dev(dev
, BLK_OPEN_READ
| BLK_OPEN_NDELAY
,
2516 if (IS_ERR(bdev_file
))
2517 return PTR_ERR(bdev_file
);
2518 sdev
= scsi_device_from_queue(file_bdev(bdev_file
)->bd_disk
->queue
);
2523 put_device(&sdev
->sdev_gendev
);
2525 /* This is safe, since we have a reference from open(). */
2526 __module_get(THIS_MODULE
);
2528 pd
->bdev_file
= bdev_file
;
2529 set_blocksize(file_bdev(bdev_file
), CD_FRAMESIZE
);
2531 atomic_set(&pd
->cdrw
.pending_bios
, 0);
2532 pd
->cdrw
.thread
= kthread_run(kcdrwd
, pd
, "%s", pd
->disk
->disk_name
);
2533 if (IS_ERR(pd
->cdrw
.thread
)) {
2534 dev_err(ddev
, "can't start kernel thread\n");
2538 proc_create_single_data(pd
->disk
->disk_name
, 0, pkt_proc
, pkt_seq_show
, pd
);
2539 dev_notice(ddev
, "writer mapped to %pg\n", file_bdev(bdev_file
));
2544 /* This is safe: open() is still holding a reference. */
2545 module_put(THIS_MODULE
);
2549 static int pkt_ioctl(struct block_device
*bdev
, blk_mode_t mode
,
2550 unsigned int cmd
, unsigned long arg
)
2552 struct pktcdvd_device
*pd
= bdev
->bd_disk
->private_data
;
2553 struct device
*ddev
= disk_to_dev(pd
->disk
);
2556 dev_dbg(ddev
, "cmd %x, dev %d:%d\n", cmd
, MAJOR(bdev
->bd_dev
), MINOR(bdev
->bd_dev
));
2558 mutex_lock(&pktcdvd_mutex
);
2562 * The door gets locked when the device is opened, so we
2563 * have to unlock it or else the eject command fails.
2565 if (pd
->refcnt
== 1)
2566 pkt_lock_door(pd
, 0);
2569 * forward selected CDROM ioctls to CD-ROM, for UDF
2571 case CDROMMULTISESSION
:
2572 case CDROMREADTOCENTRY
:
2573 case CDROM_LAST_WRITTEN
:
2574 case CDROM_SEND_PACKET
:
2575 case SCSI_IOCTL_SEND_COMMAND
:
2576 if (!bdev
->bd_disk
->fops
->ioctl
)
2579 ret
= bdev
->bd_disk
->fops
->ioctl(bdev
, mode
, cmd
, arg
);
2582 dev_dbg(ddev
, "Unknown ioctl (%x)\n", cmd
);
2585 mutex_unlock(&pktcdvd_mutex
);
2590 static unsigned int pkt_check_events(struct gendisk
*disk
,
2591 unsigned int clearing
)
2593 struct pktcdvd_device
*pd
= disk
->private_data
;
2594 struct gendisk
*attached_disk
;
2600 attached_disk
= file_bdev(pd
->bdev_file
)->bd_disk
;
2601 if (!attached_disk
|| !attached_disk
->fops
->check_events
)
2603 return attached_disk
->fops
->check_events(attached_disk
, clearing
);
2606 static char *pkt_devnode(struct gendisk
*disk
, umode_t
*mode
)
2608 return kasprintf(GFP_KERNEL
, "pktcdvd/%s", disk
->disk_name
);
2611 static const struct block_device_operations pktcdvd_ops
= {
2612 .owner
= THIS_MODULE
,
2613 .submit_bio
= pkt_submit_bio
,
2615 .release
= pkt_release
,
2617 .compat_ioctl
= blkdev_compat_ptr_ioctl
,
2618 .check_events
= pkt_check_events
,
2619 .devnode
= pkt_devnode
,
2623 * Set up mapping from pktcdvd device to CD-ROM device.
2625 static int pkt_setup_dev(dev_t dev
, dev_t
* pkt_dev
)
2627 struct queue_limits lim
= {
2628 .max_hw_sectors
= PACKET_MAX_SECTORS
,
2629 .logical_block_size
= CD_FRAMESIZE
,
2633 struct pktcdvd_device
*pd
;
2634 struct gendisk
*disk
;
2636 mutex_lock_nested(&ctl_mutex
, SINGLE_DEPTH_NESTING
);
2638 for (idx
= 0; idx
< MAX_WRITERS
; idx
++)
2641 if (idx
== MAX_WRITERS
) {
2642 pr_err("max %d writers supported\n", MAX_WRITERS
);
2647 pd
= kzalloc(sizeof(struct pktcdvd_device
), GFP_KERNEL
);
2651 ret
= mempool_init_kmalloc_pool(&pd
->rb_pool
, PKT_RB_POOL_SIZE
,
2652 sizeof(struct pkt_rb_node
));
2656 INIT_LIST_HEAD(&pd
->cdrw
.pkt_free_list
);
2657 INIT_LIST_HEAD(&pd
->cdrw
.pkt_active_list
);
2658 spin_lock_init(&pd
->cdrw
.active_list_lock
);
2660 spin_lock_init(&pd
->lock
);
2661 spin_lock_init(&pd
->iosched
.lock
);
2662 bio_list_init(&pd
->iosched
.read_queue
);
2663 bio_list_init(&pd
->iosched
.write_queue
);
2664 init_waitqueue_head(&pd
->wqueue
);
2665 pd
->bio_queue
= RB_ROOT
;
2667 pd
->write_congestion_on
= write_congestion_on
;
2668 pd
->write_congestion_off
= write_congestion_off
;
2670 disk
= blk_alloc_disk(&lim
, NUMA_NO_NODE
);
2672 ret
= PTR_ERR(disk
);
2676 disk
->major
= pktdev_major
;
2677 disk
->first_minor
= idx
;
2679 disk
->fops
= &pktcdvd_ops
;
2680 disk
->flags
= GENHD_FL_REMOVABLE
| GENHD_FL_NO_PART
;
2681 snprintf(disk
->disk_name
, sizeof(disk
->disk_name
), DRIVER_NAME
"%d", idx
);
2682 disk
->private_data
= pd
;
2684 pd
->pkt_dev
= MKDEV(pktdev_major
, idx
);
2685 ret
= pkt_new_dev(pd
, dev
);
2689 /* inherit events of the host device */
2690 disk
->events
= file_bdev(pd
->bdev_file
)->bd_disk
->events
;
2692 ret
= add_disk(disk
);
2696 pkt_sysfs_dev_new(pd
);
2697 pkt_debugfs_dev_new(pd
);
2701 *pkt_dev
= pd
->pkt_dev
;
2703 mutex_unlock(&ctl_mutex
);
2709 mempool_exit(&pd
->rb_pool
);
2712 mutex_unlock(&ctl_mutex
);
2713 pr_err("setup of pktcdvd device failed\n");
2718 * Tear down mapping from pktcdvd device to CD-ROM device.
2720 static int pkt_remove_dev(dev_t pkt_dev
)
2722 struct pktcdvd_device
*pd
;
2723 struct device
*ddev
;
2727 mutex_lock_nested(&ctl_mutex
, SINGLE_DEPTH_NESTING
);
2729 for (idx
= 0; idx
< MAX_WRITERS
; idx
++) {
2731 if (pd
&& (pd
->pkt_dev
== pkt_dev
))
2734 if (idx
== MAX_WRITERS
) {
2735 pr_debug("dev not setup\n");
2740 if (pd
->refcnt
> 0) {
2745 ddev
= disk_to_dev(pd
->disk
);
2747 if (!IS_ERR(pd
->cdrw
.thread
))
2748 kthread_stop(pd
->cdrw
.thread
);
2750 pkt_devs
[idx
] = NULL
;
2752 pkt_debugfs_dev_remove(pd
);
2753 pkt_sysfs_dev_remove(pd
);
2755 fput(pd
->bdev_file
);
2757 remove_proc_entry(pd
->disk
->disk_name
, pkt_proc
);
2758 dev_notice(ddev
, "writer unmapped\n");
2760 del_gendisk(pd
->disk
);
2763 mempool_exit(&pd
->rb_pool
);
2766 /* This is safe: open() is still holding a reference. */
2767 module_put(THIS_MODULE
);
2770 mutex_unlock(&ctl_mutex
);
2774 static void pkt_get_status(struct pkt_ctrl_command
*ctrl_cmd
)
2776 struct pktcdvd_device
*pd
;
2778 mutex_lock_nested(&ctl_mutex
, SINGLE_DEPTH_NESTING
);
2780 pd
= pkt_find_dev_from_minor(ctrl_cmd
->dev_index
);
2782 ctrl_cmd
->dev
= new_encode_dev(file_bdev(pd
->bdev_file
)->bd_dev
);
2783 ctrl_cmd
->pkt_dev
= new_encode_dev(pd
->pkt_dev
);
2786 ctrl_cmd
->pkt_dev
= 0;
2788 ctrl_cmd
->num_devices
= MAX_WRITERS
;
2790 mutex_unlock(&ctl_mutex
);
2793 static long pkt_ctl_ioctl(struct file
*file
, unsigned int cmd
, unsigned long arg
)
2795 void __user
*argp
= (void __user
*)arg
;
2796 struct pkt_ctrl_command ctrl_cmd
;
2800 if (cmd
!= PACKET_CTRL_CMD
)
2803 if (copy_from_user(&ctrl_cmd
, argp
, sizeof(struct pkt_ctrl_command
)))
2806 switch (ctrl_cmd
.command
) {
2807 case PKT_CTRL_CMD_SETUP
:
2808 if (!capable(CAP_SYS_ADMIN
))
2810 ret
= pkt_setup_dev(new_decode_dev(ctrl_cmd
.dev
), &pkt_dev
);
2811 ctrl_cmd
.pkt_dev
= new_encode_dev(pkt_dev
);
2813 case PKT_CTRL_CMD_TEARDOWN
:
2814 if (!capable(CAP_SYS_ADMIN
))
2816 ret
= pkt_remove_dev(new_decode_dev(ctrl_cmd
.pkt_dev
));
2818 case PKT_CTRL_CMD_STATUS
:
2819 pkt_get_status(&ctrl_cmd
);
2825 if (copy_to_user(argp
, &ctrl_cmd
, sizeof(struct pkt_ctrl_command
)))
2830 #ifdef CONFIG_COMPAT
2831 static long pkt_ctl_compat_ioctl(struct file
*file
, unsigned int cmd
, unsigned long arg
)
2833 return pkt_ctl_ioctl(file
, cmd
, (unsigned long)compat_ptr(arg
));
2837 static const struct file_operations pkt_ctl_fops
= {
2838 .open
= nonseekable_open
,
2839 .unlocked_ioctl
= pkt_ctl_ioctl
,
2840 #ifdef CONFIG_COMPAT
2841 .compat_ioctl
= pkt_ctl_compat_ioctl
,
2843 .owner
= THIS_MODULE
,
2844 .llseek
= no_llseek
,
2847 static struct miscdevice pkt_misc
= {
2848 .minor
= MISC_DYNAMIC_MINOR
,
2849 .name
= DRIVER_NAME
,
2850 .nodename
= "pktcdvd/control",
2851 .fops
= &pkt_ctl_fops
2854 static int __init
pkt_init(void)
2858 mutex_init(&ctl_mutex
);
2860 ret
= mempool_init_kmalloc_pool(&psd_pool
, PSD_POOL_SIZE
,
2861 sizeof(struct packet_stacked_data
));
2864 ret
= bioset_init(&pkt_bio_set
, BIO_POOL_SIZE
, 0, 0);
2866 mempool_exit(&psd_pool
);
2870 ret
= register_blkdev(pktdev_major
, DRIVER_NAME
);
2872 pr_err("unable to register block device\n");
2878 ret
= pkt_sysfs_init();
2884 ret
= misc_register(&pkt_misc
);
2886 pr_err("unable to register misc device\n");
2890 pkt_proc
= proc_mkdir("driver/"DRIVER_NAME
, NULL
);
2895 pkt_debugfs_cleanup();
2896 pkt_sysfs_cleanup();
2898 unregister_blkdev(pktdev_major
, DRIVER_NAME
);
2900 mempool_exit(&psd_pool
);
2901 bioset_exit(&pkt_bio_set
);
2905 static void __exit
pkt_exit(void)
2907 remove_proc_entry("driver/"DRIVER_NAME
, NULL
);
2908 misc_deregister(&pkt_misc
);
2910 pkt_debugfs_cleanup();
2911 pkt_sysfs_cleanup();
2913 unregister_blkdev(pktdev_major
, DRIVER_NAME
);
2914 mempool_exit(&psd_pool
);
2915 bioset_exit(&pkt_bio_set
);
2918 MODULE_DESCRIPTION("Packet writing layer for CD/DVD drives");
2919 MODULE_AUTHOR("Jens Axboe <axboe@suse.de>");
2920 MODULE_LICENSE("GPL");
2922 module_init(pkt_init
);
2923 module_exit(pkt_exit
);