chiark / gitweb /
cdrom_id: Fix DVD blank detection for sloppy firmware
[elogind.git] / extras / cdrom_id / cdrom_id.c
1 /*
2  * cdrom_id - optical drive and media information prober
3  *
4  * Copyright (C) 2008-2010 Kay Sievers <kay.sievers@vrfy.org>
5  *
6  * This program is free software: you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation, either version 2 of the License, or
9  * (at your option) any later version.
10  *
11  * This program is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  * GNU General Public License for more details.
15  *
16  * You should have received a copy of the GNU General Public License
17  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
18  */
19
20 #ifndef _GNU_SOURCE
21 #define _GNU_SOURCE 1
22 #endif
23
24 #include <stdio.h>
25 #include <stddef.h>
26 #include <stdlib.h>
27 #include <unistd.h>
28 #include <string.h>
29 #include <limits.h>
30 #include <fcntl.h>
31 #include <errno.h>
32 #include <getopt.h>
33 #include <time.h>
34 #include <scsi/sg.h>
35 #include <sys/types.h>
36 #include <sys/stat.h>
37 #include <sys/time.h>
38 #include <sys/ioctl.h>
39 #include <linux/cdrom.h>
40
41 #include "libudev.h"
42 #include "libudev-private.h"
43
44 static int debug;
45
46 static void log_fn(struct udev *udev, int priority,
47                    const char *file, int line, const char *fn,
48                    const char *format, va_list args)
49 {
50         if (debug) {
51                 fprintf(stderr, "%s: ", fn);
52                 vfprintf(stderr, format, args);
53         } else {
54                 vsyslog(priority, format, args);
55         }
56 }
57
58 /* device info */
59 static unsigned int cd_cd_rom = 0;
60 static unsigned int cd_cd_r = 0;
61 static unsigned int cd_cd_rw = 0;
62 static unsigned int cd_dvd_rom = 0;
63 static unsigned int cd_dvd_r = 0;
64 static unsigned int cd_dvd_rw = 0;
65 static unsigned int cd_dvd_ram = 0;
66 static unsigned int cd_dvd_plus_r = 0;
67 static unsigned int cd_dvd_plus_rw = 0;
68 static unsigned int cd_dvd_plus_r_dl = 0;
69 static unsigned int cd_dvd_plus_rw_dl = 0;
70 static unsigned int cd_bd = 0;
71 static unsigned int cd_bd_r = 0;
72 static unsigned int cd_bd_re = 0;
73 static unsigned int cd_hddvd = 0;
74 static unsigned int cd_hddvd_r = 0;
75 static unsigned int cd_hddvd_rw = 0;
76 static unsigned int cd_mo = 0;
77 static unsigned int cd_mrw = 0;
78 static unsigned int cd_mrw_w = 0;
79
80 /* media info */
81 static unsigned int cd_media = 0;
82 static unsigned int cd_media_cd_rom = 0;
83 static unsigned int cd_media_cd_r = 0;
84 static unsigned int cd_media_cd_rw = 0;
85 static unsigned int cd_media_dvd_rom = 0;
86 static unsigned int cd_media_dvd_r = 0;
87 static unsigned int cd_media_dvd_rw = 0;
88 static unsigned int cd_media_dvd_rw_ro = 0; /* restricted overwrite mode */
89 static unsigned int cd_media_dvd_rw_seq = 0; /* sequential mode */
90 static unsigned int cd_media_dvd_ram = 0;
91 static unsigned int cd_media_dvd_plus_r = 0;
92 static unsigned int cd_media_dvd_plus_rw = 0;
93 static unsigned int cd_media_dvd_plus_r_dl = 0;
94 static unsigned int cd_media_dvd_plus_rw_dl = 0;
95 static unsigned int cd_media_bd = 0;
96 static unsigned int cd_media_bd_r = 0;
97 static unsigned int cd_media_bd_re = 0;
98 static unsigned int cd_media_hddvd = 0;
99 static unsigned int cd_media_hddvd_r = 0;
100 static unsigned int cd_media_hddvd_rw = 0;
101 static unsigned int cd_media_mo = 0;
102 static unsigned int cd_media_mrw = 0;
103 static unsigned int cd_media_mrw_w = 0;
104
105 static const char *cd_media_state = NULL;
106 static unsigned int cd_media_session_next = 0;
107 static unsigned int cd_media_session_count = 0;
108 static unsigned int cd_media_track_count = 0;
109 static unsigned int cd_media_track_count_data = 0;
110 static unsigned int cd_media_track_count_audio = 0;
111 static unsigned long long int cd_media_session_last_offset = 0;
112
113 #define ERRCODE(s)      ((((s)[2] & 0x0F) << 16) | ((s)[12] << 8) | ((s)[13]))
114 #define SK(errcode)     (((errcode) >> 16) & 0xF)
115 #define ASC(errcode)    (((errcode) >> 8) & 0xFF)
116 #define ASCQ(errcode)   ((errcode) & 0xFF)
117
118 static int is_mounted(const char *device)
119 {
120         struct stat statbuf;
121         FILE *fp;
122         int maj, min;
123         int mounted = 0;
124
125         if (stat(device, &statbuf) < 0)
126                 return -ENODEV;
127
128         fp = fopen("/proc/self/mountinfo", "r");
129         if (fp == NULL)
130                 return -ENOSYS;
131         while (fscanf(fp, "%*s %*s %i:%i %*[^\n]", &maj, &min) == 2) {
132                 if (makedev(maj, min) == statbuf.st_rdev) {
133                         mounted = 1;
134                         break;
135                 }
136         }
137         fclose(fp);
138         return mounted;
139 }
140
141 static void info_scsi_cmd_err(struct udev *udev, char *cmd, int err)
142 {
143         if (err == -1) {
144                 info(udev, "%s failed\n", cmd);
145                 return;
146         }
147         info(udev, "%s failed with SK=%Xh/ASC=%02Xh/ACQ=%02Xh\n", cmd, SK(err), ASC(err), ASCQ(err));
148 }
149
150 struct scsi_cmd {
151         struct cdrom_generic_command cgc;
152         union {
153                 struct request_sense s;
154                 unsigned char u[18];
155         } _sense;
156         struct sg_io_hdr sg_io;
157 };
158
159 static void scsi_cmd_init(struct udev *udev, struct scsi_cmd *cmd, unsigned char *buf, size_t bufsize)
160 {
161         memset(cmd, 0x00, sizeof(struct scsi_cmd));
162         memset(buf, 0x00, bufsize);
163         cmd->cgc.quiet = 1;
164         cmd->cgc.sense = &cmd->_sense.s;
165         memset(&cmd->sg_io, 0, sizeof(cmd->sg_io));
166         cmd->sg_io.interface_id = 'S';
167         cmd->sg_io.mx_sb_len = sizeof(cmd->_sense);
168         cmd->sg_io.cmdp = cmd->cgc.cmd;
169         cmd->sg_io.sbp = cmd->_sense.u;
170         cmd->sg_io.flags = SG_FLAG_LUN_INHIBIT | SG_FLAG_DIRECT_IO;
171 }
172
173 static void scsi_cmd_set(struct udev *udev, struct scsi_cmd *cmd, size_t i, unsigned char arg)
174 {
175         cmd->sg_io.cmd_len = i + 1;
176         cmd->cgc.cmd[i] = arg;
177 }
178
179 #define CHECK_CONDITION 0x01
180
181 static int scsi_cmd_run(struct udev *udev, struct scsi_cmd *cmd, int fd, unsigned char *buf, size_t bufsize)
182 {
183         int ret = 0;
184
185         cmd->sg_io.dxferp = buf;
186         cmd->sg_io.dxfer_len = bufsize;
187         cmd->sg_io.dxfer_direction = SG_DXFER_FROM_DEV;
188         if (ioctl(fd, SG_IO, &cmd->sg_io))
189                 return -1;
190
191         if ((cmd->sg_io.info & SG_INFO_OK_MASK) != SG_INFO_OK) {
192                 errno = EIO;
193                 ret = -1;
194                 if (cmd->sg_io.masked_status & CHECK_CONDITION) {
195                         ret = ERRCODE(cmd->_sense.u);
196                         if (ret == 0)
197                                 ret = -1;
198                 }
199         }
200         return ret;
201 }
202
203 static int cd_capability_compat(struct udev *udev, int fd)
204 {
205         int capability;
206
207         capability = ioctl(fd, CDROM_GET_CAPABILITY, NULL);
208         if (capability < 0) {
209                 info(udev, "CDROM_GET_CAPABILITY failed\n");
210                 return -1;
211         }
212
213         if (capability & CDC_CD_R)
214                 cd_cd_r = 1;
215         if (capability & CDC_CD_RW)
216                 cd_cd_rw = 1;
217         if (capability & CDC_DVD)
218                 cd_dvd_rom = 1;
219         if (capability & CDC_DVD_R)
220                 cd_dvd_r = 1;
221         if (capability & CDC_DVD_RAM)
222                 cd_dvd_ram = 1;
223         if (capability & CDC_MRW)
224                 cd_mrw = 1;
225         if (capability & CDC_MRW_W)
226                 cd_mrw_w = 1;
227         return 0;
228 }
229
230 static int cd_media_compat(struct udev *udev, int fd)
231 {
232         if (ioctl(fd, CDROM_DRIVE_STATUS, CDSL_CURRENT) != CDS_DISC_OK) {
233                 info(udev, "CDROM_DRIVE_STATUS != CDS_DISC_OK\n");
234                 return -1;
235         }
236         cd_media = 1;
237         return 0;
238 }
239
240 static int cd_inquiry(struct udev *udev, int fd) {
241         struct scsi_cmd sc;
242         unsigned char inq[128];
243         int err;
244
245         scsi_cmd_init(udev, &sc, inq, sizeof(inq));
246         scsi_cmd_set(udev, &sc, 0, 0x12);
247         scsi_cmd_set(udev, &sc, 4, 36);
248         scsi_cmd_set(udev, &sc, 5, 0);
249         err = scsi_cmd_run(udev, &sc, fd, inq, 36);
250         if ((err != 0)) {
251                 info_scsi_cmd_err(udev, "INQUIRY", err);
252                 return -1;
253         }
254
255         if ((inq[0] & 0x1F) != 5) {
256                 info(udev, "not an MMC unit\n");
257                 return -1;
258         }
259
260         info(udev, "INQUIRY: [%.8s][%.16s][%.4s]\n", inq + 8, inq + 16, inq + 32);
261         return 0;
262 }
263
264 static int feature_profiles(struct udev *udev, const unsigned char *profiles, size_t size)
265 {
266         unsigned int i;
267
268         for (i = 0; i+4 <= size; i += 4) {
269                 int profile;
270
271                 profile = profiles[i] << 8 | profiles[i+1];
272                 switch (profile) {
273                 case 0x03:
274                 case 0x04:
275                 case 0x05:
276                         info(udev, "profile 0x%02x mo\n", profile);
277                         cd_mo = 1;
278                         break;
279                 case 0x08:
280                         info(udev, "profile 0x%02x cd_rom\n", profile);
281                         cd_cd_rom = 1;
282                         break;
283                 case 0x09:
284                         info(udev, "profile 0x%02x cd_r\n", profile);
285                         cd_cd_r = 1;
286                         break;
287                 case 0x0A:
288                         info(udev, "profile 0x%02x cd_rw\n", profile);
289                         cd_cd_rw = 1;
290                         break;
291                 case 0x10:
292                         info(udev, "profile 0x%02x dvd_rom\n", profile);
293                         cd_dvd_rom = 1;
294                         break;
295                 case 0x12:
296                         info(udev, "profile 0x%02x dvd_ram\n", profile);
297                         cd_dvd_ram = 1;
298                         break;
299                 case 0x13:
300                 case 0x14:
301                         info(udev, "profile 0x%02x dvd_rw\n", profile);
302                         cd_dvd_rw = 1;
303                         break;
304                 case 0x1B:
305                         info(udev, "profile 0x%02x dvd_plus_r\n", profile);
306                         cd_dvd_plus_r = 1;
307                         break;
308                 case 0x1A:
309                         info(udev, "profile 0x%02x dvd_plus_rw\n", profile);
310                         cd_dvd_plus_rw = 1;
311                         break;
312                 case 0x2A:
313                         info(udev, "profile 0x%02x dvd_plus_rw_dl\n", profile);
314                         cd_dvd_plus_rw_dl = 1;
315                         break;
316                 case 0x2B:
317                         info(udev, "profile 0x%02x dvd_plus_r_dl\n", profile);
318                         cd_dvd_plus_r_dl = 1;
319                         break;
320                 case 0x40:
321                         cd_bd = 1;
322                         info(udev, "profile 0x%02x bd\n", profile);
323                         break;
324                 case 0x41:
325                 case 0x42:
326                         cd_bd_r = 1;
327                         info(udev, "profile 0x%02x bd_r\n", profile);
328                         break;
329                 case 0x43:
330                         cd_bd_re = 1;
331                         info(udev, "profile 0x%02x bd_re\n", profile);
332                         break;
333                 case 0x50:
334                         cd_hddvd = 1;
335                         info(udev, "profile 0x%02x hddvd\n", profile);
336                         break;
337                 case 0x51:
338                         cd_hddvd_r = 1;
339                         info(udev, "profile 0x%02x hddvd_r\n", profile);
340                         break;
341                 case 0x52:
342                         cd_hddvd_rw = 1;
343                         info(udev, "profile 0x%02x hddvd_rw\n", profile);
344                         break;
345                 default:
346                         info(udev, "profile 0x%02x <ignored>\n", profile);
347                         break;
348                 }
349         }
350         return 0;
351 }
352
353 static int cd_profiles_old_mmc(struct udev *udev, int fd)
354 {
355         struct scsi_cmd sc;
356         int err;
357
358         unsigned char header[32];
359
360         scsi_cmd_init(udev, &sc, header, sizeof(header));
361         scsi_cmd_set(udev, &sc, 0, 0x51);
362         scsi_cmd_set(udev, &sc, 8, sizeof(header));
363         scsi_cmd_set(udev, &sc, 9, 0);
364         err = scsi_cmd_run(udev, &sc, fd, header, sizeof(header));
365         if ((err != 0)) {
366                 info_scsi_cmd_err(udev, "READ DISC INFORMATION", err);
367                 info(udev, "no current profile, assuming no media\n");
368                 return -1;
369         };
370
371         cd_media = 1;
372
373         if (header[2] & 16) {
374                 cd_media_cd_rw = 1;
375                 info(udev, "profile 0x0a media_cd_rw\n");
376         } else if ((header[2] & 3) < 2 && cd_cd_r) {
377                 cd_media_cd_r = 1;
378                 info(udev, "profile 0x09 media_cd_r\n");
379         } else {
380                 cd_media_cd_rom = 1;
381                 info(udev, "profile 0x08 media_cd_rom\n");
382         }
383         return 0;
384 }
385
386 static int cd_profiles(struct udev *udev, int fd)
387 {
388         struct scsi_cmd sc;
389         unsigned char features[65530];
390         unsigned int cur_profile = 0;
391         unsigned int len;
392         unsigned int i;
393         int err;
394
395         scsi_cmd_init(udev, &sc, features, sizeof(features));
396         scsi_cmd_set(udev, &sc, 0, 0x46);
397         scsi_cmd_set(udev, &sc, 7, (sizeof(features) >> 8) & 0xff);
398         scsi_cmd_set(udev, &sc, 8, sizeof(features) & 0xff);
399         scsi_cmd_set(udev, &sc, 9, 0);
400         err = scsi_cmd_run(udev, &sc, fd, features, sizeof(features));
401         if ((err != 0)) {
402                 info_scsi_cmd_err(udev, "GET CONFIGURATION", err);
403                 /* handle pre-MMC2 drives which do not support GET CONFIGURATION */
404                 if (SK(err) == 0x5 && ASC(err) == 0x20) {
405                         info(udev, "drive is pre-MMC2 and does not support 46h get configuration command\n");
406                         info(udev, "trying to work around the problem\n");
407                         return cd_profiles_old_mmc(udev, fd);
408                 }
409                 return -1;
410         }
411
412         len = features[0] << 24 | features[1] << 16 | features[2] << 8 | features[3];
413         info(udev, "GET CONFIGURATION: size of features buffer 0x%04x\n", len);
414
415         if (len > sizeof(features)) {
416                 info(udev, "can not get features in a single query, truncating\n");
417                 len = sizeof(features);
418         }
419
420         /* device features */
421         for (i = 8; i+4 < len; i += (4 + features[i+3])) {
422                 unsigned int feature;
423
424                 feature = features[i] << 8 | features[i+1];
425
426                 switch (feature) {
427                 case 0x00:
428                         info(udev, "GET CONFIGURATION: feature 'profiles', with %i entries\n", features[i+3] / 4);
429                         feature_profiles(udev, &features[i]+4, features[i+3]);
430                         break;
431                 default:
432                         info(udev, "GET CONFIGURATION: feature 0x%04x <ignored>, with 0x%02x bytes\n", feature, features[i+3]);
433                         break;
434                 }
435         }
436
437         cur_profile = features[6] << 8 | features[7];
438         if (cur_profile > 0) {
439                 info(udev, "current profile 0x%02x\n", cur_profile);
440         } else {
441                 info(udev, "no current profile, assuming no media\n");
442                 return -1;
443         }
444
445         switch (cur_profile) {
446         case 0x03:
447         case 0x04:
448         case 0x05:
449                 info(udev, "profile 0x%02x \n", cur_profile);
450                 cd_media = 1;
451                 cd_media_mo = 1;
452                 break;
453         case 0x08:
454                 info(udev, "profile 0x%02x media_cd_rom\n", cur_profile);
455                 cd_media = 1;
456                 cd_media_cd_rom = 1;
457                 break;
458         case 0x09:
459                 info(udev, "profile 0x%02x media_cd_r\n", cur_profile);
460                 cd_media = 1;
461                 cd_media_cd_r = 1;
462                 break;
463         case 0x0a:
464                 info(udev, "profile 0x%02x media_cd_rw\n", cur_profile);
465                 cd_media = 1;
466                 cd_media_cd_rw = 1;
467                 break;
468         case 0x10:
469                 info(udev, "profile 0x%02x media_dvd_ro\n", cur_profile);
470                 cd_media = 1;
471                 cd_media_dvd_rom = 1;
472                 break;
473         case 0x11:
474                 info(udev, "profile 0x%02x media_dvd_r\n", cur_profile);
475                 cd_media = 1;
476                 cd_media_dvd_r = 1;
477                 break;
478         case 0x12:
479                 info(udev, "profile 0x%02x media_dvd_ram\n", cur_profile);
480                 cd_media = 1;
481                 cd_media_dvd_ram = 1;
482                 break;
483         case 0x13:
484                 info(udev, "profile 0x%02x media_dvd_rw_ro\n", cur_profile);
485                 cd_media = 1;
486                 cd_media_dvd_rw = 1;
487                 cd_media_dvd_rw_ro = 1;
488                 break;
489         case 0x14:
490                 info(udev, "profile 0x%02x media_dvd_rw_seq\n", cur_profile);
491                 cd_media = 1;
492                 cd_media_dvd_rw = 1;
493                 cd_media_dvd_rw_seq = 1;
494                 break;
495         case 0x1B:
496                 info(udev, "profile 0x%02x media_dvd_plus_r\n", cur_profile);
497                 cd_media = 1;
498                 cd_media_dvd_plus_r = 1;
499                 break;
500         case 0x1A:
501                 info(udev, "profile 0x%02x media_dvd_plus_rw\n", cur_profile);
502                 cd_media = 1;
503                 cd_media_dvd_plus_rw = 1;
504                 break;
505         case 0x2A:
506                 info(udev, "profile 0x%02x media_dvd_plus_rw_dl\n", cur_profile);
507                 cd_media = 1;
508                 cd_media_dvd_plus_rw_dl = 1;
509                 break;
510         case 0x2B:
511                 info(udev, "profile 0x%02x media_dvd_plus_r_dl\n", cur_profile);
512                 cd_media = 1;
513                 cd_media_dvd_plus_r_dl = 1;
514                 break;
515         case 0x40:
516                 info(udev, "profile 0x%02x media_bd\n", cur_profile);
517                 cd_media = 1;
518                 cd_media_bd = 1;
519                 break;
520         case 0x41:
521         case 0x42:
522                 info(udev, "profile 0x%02x media_bd_r\n", cur_profile);
523                 cd_media = 1;
524                 cd_media_bd_r = 1;
525                 break;
526         case 0x43:
527                 info(udev, "profile 0x%02x media_bd_re\n", cur_profile);
528                 cd_media = 1;
529                 cd_media_bd_re = 1;
530                 break;
531         case 0x50:
532                 info(udev, "profile 0x%02x media_hddvd\n", cur_profile);
533                 cd_media = 1;
534                 cd_media_hddvd = 1;
535                 break;
536         case 0x51:
537                 info(udev, "profile 0x%02x media_hddvd_r\n", cur_profile);
538                 cd_media = 1;
539                 cd_media_hddvd_r = 1;
540                 break;
541         case 0x52:
542                 info(udev, "profile 0x%02x media_hddvd_rw\n", cur_profile);
543                 cd_media = 1;
544                 cd_media_hddvd_rw = 1;
545                 break;
546         default:
547                 info(udev, "profile 0x%02x <ignored>\n", cur_profile);
548                 break;
549         }
550         return 0;
551 }
552
553 static int cd_media_info(struct udev *udev, int fd)
554 {
555         struct scsi_cmd sc;
556         unsigned char header[32];
557         static const char *media_status[] = {
558                 "blank",
559                 "appendable",
560                 "complete",
561                 "other"
562         };
563         int err;
564
565         scsi_cmd_init(udev, &sc, header, sizeof(header));
566         scsi_cmd_set(udev, &sc, 0, 0x51);
567         scsi_cmd_set(udev, &sc, 8, sizeof(header) & 0xff);
568         scsi_cmd_set(udev, &sc, 9, 0);
569         err = scsi_cmd_run(udev, &sc, fd, header, sizeof(header));
570         if ((err != 0)) {
571                 info_scsi_cmd_err(udev, "READ DISC INFORMATION", err);
572                 return -1;
573         };
574
575         cd_media = 1;
576         info(udev, "disk type %02x\n", header[8]);
577         info(udev, "hardware reported media status: %s\n", media_status[header[2] & 3]);
578
579         /* exclude plain CDROM, some fake cdroms return 0 for "blank" media here */
580         if (!cd_media_cd_rom)
581                 cd_media_state = media_status[header[2] & 3];
582
583         /* fresh DVD-RW in restricted overwite mode reports itself as
584          * "appendable"; change it to "blank" to make it consistent with what
585          * gets reported after blanking, and what userspace expects  */
586         if (cd_media_dvd_rw_ro && (header[2] & 3) == 1)
587                 cd_media_state = media_status[0];
588
589         /* DVD+RW discs (and DVD-RW in restricted mode) once formatted are
590          * always "complete", DVD-RAM are "other" or "complete" if the disc is
591          * write protected; we need to check the contents if it is blank */
592         if ((cd_media_dvd_rw_ro || cd_media_dvd_plus_rw || cd_media_dvd_plus_rw_dl || cd_media_dvd_ram) && (header[2] & 3) > 1) {
593                 unsigned char buffer[32 * 2048];
594                 unsigned char result, len;
595                 int block, offset;
596
597                 if (cd_media_dvd_ram) {
598                         /* a write protected dvd-ram may report "complete" status */
599
600                         unsigned char dvdstruct[8];
601                         unsigned char format[12];
602
603                         scsi_cmd_init(udev, &sc, dvdstruct, sizeof(dvdstruct));
604                         scsi_cmd_set(udev, &sc, 0, 0xAD);
605                         scsi_cmd_set(udev, &sc, 7, 0xC0);
606                         scsi_cmd_set(udev, &sc, 9, sizeof(dvdstruct));
607                         scsi_cmd_set(udev, &sc, 11, 0);
608                         err = scsi_cmd_run(udev, &sc, fd, dvdstruct, sizeof(dvdstruct));
609                         if ((err != 0)) {
610                                 info_scsi_cmd_err(udev, "READ DVD STRUCTURE", err);
611                                 return -1;
612                         }
613                         if (dvdstruct[4] & 0x02) {
614                                 cd_media_state = media_status[2];
615                                 info(udev, "write-protected DVD-RAM media inserted\n");
616                                 goto determined;
617                         }
618
619                         /* let's make sure we don't try to read unformatted media */
620                         scsi_cmd_init(udev, &sc, format, sizeof(format));
621                         scsi_cmd_set(udev, &sc, 0, 0x23);
622                         scsi_cmd_set(udev, &sc, 8, sizeof(format));
623                         scsi_cmd_set(udev, &sc, 9, 0);
624                         err = scsi_cmd_run(udev, &sc, fd, format, sizeof(format));
625                         if ((err != 0)) {
626                                 info_scsi_cmd_err(udev, "READ DVD FORMAT CAPACITIES", err);
627                                 return -1;
628                         }
629
630                         len = format[3];
631                         if (len & 7 || len < 16) {
632                                 info(udev, "invalid format capacities length\n");
633                                 return -1;
634                         }
635
636                         switch(format[8] & 3) {
637                             case 1:
638                                 info(udev, "unformatted DVD-RAM media inserted\n");
639                                 /* This means that last format was interrupted
640                                  * or failed, blank dvd-ram discs are factory
641                                  * formatted. Take no action here as it takes
642                                  * quite a while to reformat a dvd-ram and it's
643                                  * not automatically started */
644                                 goto determined;
645
646                             case 2:
647                                 info(udev, "formatted DVD-RAM media inserted\n");
648                                 break;
649
650                             case 3:
651                                 cd_media = 0; //return no media
652                                 info(udev, "format capacities returned no media\n");
653                                 return -1;
654                         }
655                 }
656
657                 /* Take a closer look at formatted media (unformatted DVD+RW
658                  * has "blank" status", DVD-RAM was examined earlier) and check
659                  * for ISO and UDF PVDs or a fs superblock presence and do it
660                  * in one ioctl (we need just sectors 0 and 16) */
661                 scsi_cmd_init(udev, &sc, buffer, sizeof(buffer));
662                 scsi_cmd_set(udev, &sc, 0, 0x28);
663                 scsi_cmd_set(udev, &sc, 5, 0);
664                 scsi_cmd_set(udev, &sc, 8, 32);
665                 scsi_cmd_set(udev, &sc, 9, 0);
666                 err = scsi_cmd_run(udev, &sc, fd, buffer, sizeof(buffer));
667                 if ((err != 0)) {
668                         info_scsi_cmd_err(udev, "READ FIRST 32 BLOCKS", err);
669                         return -1;
670                 }
671
672                 /* if any non-zero data is found in sector 16 (iso and udf) or
673                  * eventually 0 (fat32 boot sector, ext2 superblock, etc), disc
674                  * is assumed non-blank */
675                 result = 0;
676
677                 for (block = 32768; block >= 0 && !result; block -= 32768) {
678                         offset = block;
679                         while (offset < (block + 2048) && !result) {
680                                 result = buffer [offset];
681                                 offset++;
682                         }
683                 }
684
685                 if (!result) {
686                         cd_media_state = media_status[0];
687                         info(udev, "no data in blocks 0 or 16, assuming blank\n");
688                 } else {
689                         info(udev, "data in blocks 0 or 16, assuming complete\n");
690                 }
691         }
692
693 determined:
694         /* "other" is e. g. DVD-RAM, can't append sessions there; DVDs in
695          * restricted overwrite mode can never append, only in sequential mode */
696         if ((header[2] & 3) < 2 && !cd_media_dvd_rw_ro)
697                 cd_media_session_next = header[10] << 8 | header[5];
698         cd_media_session_count = header[9] << 8 | header[4];
699         cd_media_track_count = header[11] << 8 | header[6];
700
701         return 0;
702 }
703
704 static int cd_media_toc(struct udev *udev, int fd)
705 {
706         struct scsi_cmd sc;
707         unsigned char header[12];
708         unsigned char toc[2048];
709         unsigned int len, i;
710         unsigned char *p;
711         int err;
712
713         scsi_cmd_init(udev, &sc, header, sizeof(header));
714         scsi_cmd_set(udev, &sc, 0, 0x43);
715         scsi_cmd_set(udev, &sc, 6, 1);
716         scsi_cmd_set(udev, &sc, 8, sizeof(header) & 0xff);
717         scsi_cmd_set(udev, &sc, 9, 0);
718         err = scsi_cmd_run(udev, &sc, fd, header, sizeof(header));
719         if ((err != 0)) {
720                 info_scsi_cmd_err(udev, "READ TOC", err);
721                 return -1;
722         }
723
724         len = (header[0] << 8 | header[1]) + 2;
725         info(udev, "READ TOC: len: %d\n", len);
726         if (len > sizeof(toc))
727                 return -1;
728         if (len < 2)
729                 return -1;
730
731         /* empty media has no tracks */
732         if (len < 8)
733                 return 0;
734
735         scsi_cmd_init(udev, &sc, toc, sizeof(toc));
736         scsi_cmd_set(udev, &sc, 0, 0x43);
737         scsi_cmd_set(udev, &sc, 6, header[2]); /* First Track/Session Number */
738         scsi_cmd_set(udev, &sc, 7, (len >> 8) & 0xff);
739         scsi_cmd_set(udev, &sc, 8, len & 0xff);
740         scsi_cmd_set(udev, &sc, 9, 0);
741         err = scsi_cmd_run(udev, &sc, fd, toc, len);
742         if ((err != 0)) {
743                 info_scsi_cmd_err(udev, "READ TOC (tracks)", err);
744                 return -1;
745         }
746
747         for (p = toc+4, i = 4; i < len-8; i += 8, p += 8) {
748                 unsigned int block;
749                 unsigned int is_data_track;
750
751                 is_data_track = (p[1] & 0x04) != 0;
752
753                 block = p[4] << 24 | p[5] << 16 | p[6] << 8 | p[7];
754                 info(udev, "track=%u info=0x%x(%s) start_block=%u\n",
755                      p[2], p[1] & 0x0f, is_data_track ? "data":"audio", block);
756
757                 if (is_data_track)
758                         cd_media_track_count_data++;
759                 else
760                         cd_media_track_count_audio++;
761         }
762
763         scsi_cmd_init(udev, &sc, header, sizeof(header));
764         scsi_cmd_set(udev, &sc, 0, 0x43);
765         scsi_cmd_set(udev, &sc, 2, 1); /* Session Info */
766         scsi_cmd_set(udev, &sc, 8, sizeof(header));
767         scsi_cmd_set(udev, &sc, 9, 0);
768         err = scsi_cmd_run(udev, &sc, fd, header, sizeof(header));
769         if ((err != 0)) {
770                 info_scsi_cmd_err(udev, "READ TOC (multi session)", err);
771                 return -1;
772         }
773         len = header[4+4] << 24 | header[4+5] << 16 | header[4+6] << 8 | header[4+7];
774         info(udev, "last track %u starts at block %u\n", header[4+2], len);
775         cd_media_session_last_offset = (unsigned long long int)len * 2048;
776         return 0;
777 }
778
779 int main(int argc, char *argv[])
780 {
781         struct udev *udev;
782         static const struct option options[] = {
783                 { "export", no_argument, NULL, 'x' },
784                 { "debug", no_argument, NULL, 'd' },
785                 { "help", no_argument, NULL, 'h' },
786                 {}
787         };
788         const char *node = NULL;
789         int export = 0;
790         int fd = -1;
791         int cnt;
792         int rc = 0;
793
794         udev = udev_new();
795         if (udev == NULL)
796                 goto exit;
797
798         udev_log_init("cdrom_id");
799         udev_set_log_fn(udev, log_fn);
800
801         while (1) {
802                 int option;
803
804                 option = getopt_long(argc, argv, "dxh", options, NULL);
805                 if (option == -1)
806                         break;
807
808                 switch (option) {
809                 case 'd':
810                         debug = 1;
811                         if (udev_get_log_priority(udev) < LOG_INFO)
812                                 udev_set_log_priority(udev, LOG_INFO);
813                         break;
814                 case 'x':
815                         export = 1;
816                         break;
817                 case 'h':
818                         printf("Usage: cdrom_id [options] <device>\n"
819                                "  --export        export key/value pairs\n"
820                                "  --debug         debug to stderr\n"
821                                "  --help          print this help text\n\n");
822                         goto exit;
823                 default:
824                         rc = 1;
825                         goto exit;
826                 }
827         }
828
829         node = argv[optind];
830         if (!node) {
831                 err(udev, "no device\n");
832                 fprintf(stderr, "no device\n");
833                 rc = 1;
834                 goto exit;
835         }
836
837         srand((unsigned int)getpid());
838         for (cnt = 20; cnt > 0; cnt--) {
839                 struct timespec duration;
840
841                 fd = open(node, O_RDONLY|O_NONBLOCK|(is_mounted(node) ? 0 : O_EXCL));
842                 if (fd >= 0 || errno != EBUSY)
843                         break;
844                 duration.tv_sec = 0;
845                 duration.tv_nsec = (100 * 1000 * 1000) + (rand() % 100 * 1000 * 1000);
846                 nanosleep(&duration, NULL);
847         }
848         if (fd < 0) {
849                 info(udev, "unable to open '%s'\n", node);
850                 fprintf(stderr, "unable to open '%s'\n", node);
851                 rc = 1;
852                 goto exit;
853         }
854         info(udev, "probing: '%s'\n", node);
855
856         /* same data as original cdrom_id */
857         if (cd_capability_compat(udev, fd) < 0) {
858                 rc = 1;
859                 goto exit;
860         }
861
862         /* check for media - don't bail if there's no media as we still need to
863          * to read profiles */
864         cd_media_compat(udev, fd);
865
866         /* check if drive talks MMC */
867         if (cd_inquiry(udev, fd) < 0)
868                 goto print;
869
870         /* read drive and possibly current profile */
871         if (cd_profiles(udev, fd) < 0)
872                 goto print;
873
874         /* get session/track info */
875         cd_media_toc(udev, fd);
876
877         /* get writable media state */
878         cd_media_info(udev, fd);
879
880 print:
881         printf("ID_CDROM=1\n");
882         if (cd_cd_rom)
883                 printf("ID_CDROM_CD=1\n");
884         if (cd_cd_r)
885                 printf("ID_CDROM_CD_R=1\n");
886         if (cd_cd_rw)
887                 printf("ID_CDROM_CD_RW=1\n");
888         if (cd_dvd_rom)
889                 printf("ID_CDROM_DVD=1\n");
890         if (cd_dvd_r)
891                 printf("ID_CDROM_DVD_R=1\n");
892         if (cd_dvd_rw)
893                 printf("ID_CDROM_DVD_RW=1\n");
894         if (cd_dvd_ram)
895                 printf("ID_CDROM_DVD_RAM=1\n");
896         if (cd_dvd_plus_r)
897                 printf("ID_CDROM_DVD_PLUS_R=1\n");
898         if (cd_dvd_plus_rw)
899                 printf("ID_CDROM_DVD_PLUS_RW=1\n");
900         if (cd_dvd_plus_r_dl)
901                 printf("ID_CDROM_DVD_PLUS_R_DL=1\n");
902         if (cd_dvd_plus_rw_dl)
903                 printf("ID_CDROM_DVD_PLUS_RW_DL=1\n");
904         if (cd_bd)
905                 printf("ID_CDROM_BD=1\n");
906         if (cd_bd_r)
907                 printf("ID_CDROM_BD_R=1\n");
908         if (cd_bd_re)
909                 printf("ID_CDROM_BD_RE=1\n");
910         if (cd_hddvd)
911                 printf("ID_CDROM_HDDVD=1\n");
912         if (cd_hddvd_r)
913                 printf("ID_CDROM_HDDVD_R=1\n");
914         if (cd_hddvd_rw)
915                 printf("ID_CDROM_HDDVD_RW=1\n");
916         if (cd_mo)
917                 printf("ID_CDROM_MO=1\n");
918         if (cd_mrw)
919                 printf("ID_CDROM_MRW=1\n");
920         if (cd_mrw_w)
921                 printf("ID_CDROM_MRW_W=1\n");
922
923         if (cd_media)
924                 printf("ID_CDROM_MEDIA=1\n");
925         if (cd_media_mo)
926                 printf("ID_CDROM_MEDIA_MO=1\n");
927         if (cd_media_mrw)
928                 printf("ID_CDROM_MEDIA_MRW=1\n");
929         if (cd_media_mrw_w)
930                 printf("ID_CDROM_MEDIA_MRW_W=1\n");
931         if (cd_media_cd_rom)
932                 printf("ID_CDROM_MEDIA_CD=1\n");
933         if (cd_media_cd_r)
934                 printf("ID_CDROM_MEDIA_CD_R=1\n");
935         if (cd_media_cd_rw)
936                 printf("ID_CDROM_MEDIA_CD_RW=1\n");
937         if (cd_media_dvd_rom)
938                 printf("ID_CDROM_MEDIA_DVD=1\n");
939         if (cd_media_dvd_r)
940                 printf("ID_CDROM_MEDIA_DVD_R=1\n");
941         if (cd_media_dvd_ram)
942                 printf("ID_CDROM_MEDIA_DVD_RAM=1\n");
943         if (cd_media_dvd_rw)
944                 printf("ID_CDROM_MEDIA_DVD_RW=1\n");
945         if (cd_media_dvd_plus_r)
946                 printf("ID_CDROM_MEDIA_DVD_PLUS_R=1\n");
947         if (cd_media_dvd_plus_rw)
948                 printf("ID_CDROM_MEDIA_DVD_PLUS_RW=1\n");
949         if (cd_media_dvd_plus_rw_dl)
950                 printf("ID_CDROM_MEDIA_DVD_PLUS_RW_DL=1\n");
951         if (cd_media_dvd_plus_r_dl)
952                 printf("ID_CDROM_MEDIA_DVD_PLUS_R_DL=1\n");
953         if (cd_media_bd)
954                 printf("ID_CDROM_MEDIA_BD=1\n");
955         if (cd_media_bd_r)
956                 printf("ID_CDROM_MEDIA_BD_R=1\n");
957         if (cd_media_bd_re)
958                 printf("ID_CDROM_MEDIA_BD_RE=1\n");
959         if (cd_media_hddvd)
960                 printf("ID_CDROM_MEDIA_HDDVD=1\n");
961         if (cd_media_hddvd_r)
962                 printf("ID_CDROM_MEDIA_HDDVD_R=1\n");
963         if (cd_media_hddvd_rw)
964                 printf("ID_CDROM_MEDIA_HDDVD_RW=1\n");
965
966         if (cd_media_state != NULL)
967                 printf("ID_CDROM_MEDIA_STATE=%s\n", cd_media_state);
968         if (cd_media_session_next > 0)
969                 printf("ID_CDROM_MEDIA_SESSION_NEXT=%d\n", cd_media_session_next);
970         if (cd_media_session_count > 0)
971                 printf("ID_CDROM_MEDIA_SESSION_COUNT=%d\n", cd_media_session_count);
972         if (cd_media_session_count > 1 && cd_media_session_last_offset > 0)
973                 printf("ID_CDROM_MEDIA_SESSION_LAST_OFFSET=%llu\n", cd_media_session_last_offset);
974         if (cd_media_track_count > 0)
975                 printf("ID_CDROM_MEDIA_TRACK_COUNT=%d\n", cd_media_track_count);
976         if (cd_media_track_count_audio > 0)
977                 printf("ID_CDROM_MEDIA_TRACK_COUNT_AUDIO=%d\n", cd_media_track_count_audio);
978         if (cd_media_track_count_data > 0)
979                 printf("ID_CDROM_MEDIA_TRACK_COUNT_DATA=%d\n", cd_media_track_count_data);
980 exit:
981         if (fd >= 0)
982                 close(fd);
983         udev_unref(udev);
984         udev_log_close();
985         return rc;
986 }
987