chiark / gitweb /
338b3782cb1782ac65aca443c20961b1e2ccf45d
[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                         info(udev, "profile 0x%02x media_dvd_rw\n", profile);
301                         cd_media_dvd_rw = 1;
302                         cd_media_dvd_rw_ro = 1;
303                         break;
304                 case 0x14:
305                         info(udev, "profile 0x%02x dvd_rw\n", profile);
306                         cd_dvd_rw = 1;
307                         cd_media_dvd_rw_seq = 1;
308                         break;
309                 case 0x1B:
310                         info(udev, "profile 0x%02x dvd_plus_r\n", profile);
311                         cd_dvd_plus_r = 1;
312                         break;
313                 case 0x1A:
314                         info(udev, "profile 0x%02x dvd_plus_rw\n", profile);
315                         cd_dvd_plus_rw = 1;
316                         break;
317                 case 0x2A:
318                         info(udev, "profile 0x%02x dvd_plus_rw_dl\n", profile);
319                         cd_dvd_plus_rw_dl = 1;
320                         break;
321                 case 0x2B:
322                         info(udev, "profile 0x%02x dvd_plus_r_dl\n", profile);
323                         cd_dvd_plus_r_dl = 1;
324                         break;
325                 case 0x40:
326                         cd_bd = 1;
327                         info(udev, "profile 0x%02x bd\n", profile);
328                         break;
329                 case 0x41:
330                 case 0x42:
331                         cd_bd_r = 1;
332                         info(udev, "profile 0x%02x bd_r\n", profile);
333                         break;
334                 case 0x43:
335                         cd_bd_re = 1;
336                         info(udev, "profile 0x%02x bd_re\n", profile);
337                         break;
338                 case 0x50:
339                         cd_hddvd = 1;
340                         info(udev, "profile 0x%02x hddvd\n", profile);
341                         break;
342                 case 0x51:
343                         cd_hddvd_r = 1;
344                         info(udev, "profile 0x%02x hddvd_r\n", profile);
345                         break;
346                 case 0x52:
347                         cd_hddvd_rw = 1;
348                         info(udev, "profile 0x%02x hddvd_rw\n", profile);
349                         break;
350                 default:
351                         info(udev, "profile 0x%02x <ignored>\n", profile);
352                         break;
353                 }
354         }
355         return 0;
356 }
357
358 static int cd_profiles_old_mmc(struct udev *udev, int fd)
359 {
360         struct scsi_cmd sc;
361         int err;
362
363         unsigned char header[32];
364
365         scsi_cmd_init(udev, &sc, header, sizeof(header));
366         scsi_cmd_set(udev, &sc, 0, 0x51);
367         scsi_cmd_set(udev, &sc, 8, sizeof(header));
368         scsi_cmd_set(udev, &sc, 9, 0);
369         err = scsi_cmd_run(udev, &sc, fd, header, sizeof(header));
370         if ((err != 0)) {
371                 info_scsi_cmd_err(udev, "READ DISC INFORMATION", err);
372                 info(udev, "no current profile, assuming no media\n");
373                 return -1;
374         };
375
376         cd_media = 1;
377
378         if (header[2] & 16) {
379                 cd_media_cd_rw = 1;
380                 info(udev, "profile 0x0a media_cd_rw\n");
381         }       
382         else if ((header[2] & 3) < 2 && cd_cd_r) { 
383                 cd_media_cd_r = 1;
384                 info(udev, "profile 0x09 media_cd_r\n");
385         }
386         else {
387         cd_media_cd_rom = 1;
388         info(udev, "profile 0x08 media_cd_rom\n");
389         }
390         return 0;
391 }
392
393 static int cd_profiles(struct udev *udev, int fd)
394 {
395         struct scsi_cmd sc;
396         unsigned char features[65530];
397         unsigned int cur_profile = 0;
398         unsigned int len;
399         unsigned int i;
400         int err;
401
402         scsi_cmd_init(udev, &sc, features, sizeof(features));
403         scsi_cmd_set(udev, &sc, 0, 0x46);
404         scsi_cmd_set(udev, &sc, 7, (sizeof(features) >> 8) & 0xff);
405         scsi_cmd_set(udev, &sc, 8, sizeof(features) & 0xff);
406         scsi_cmd_set(udev, &sc, 9, 0);
407         err = scsi_cmd_run(udev, &sc, fd, features, sizeof(features));
408         if ((err != 0)) {
409                 info_scsi_cmd_err(udev, "GET CONFIGURATION", err);
410                 /* handle pre-MMC2 drives which do not support GET CONFIGURATION */
411                 if (SK(err) == 0x5 && ASC(err) == 0x20) {
412                         info(udev, "drive is pre-MMC2 and does not support 46h get configuration command\n");
413                         info(udev, "trying to work around the problem\n");
414                         return cd_profiles_old_mmc(udev, fd);
415                 }
416                 return -1;
417         }
418
419         len = features[0] << 24 | features[1] << 16 | features[2] << 8 | features[3];
420         info(udev, "GET CONFIGURATION: size of features buffer 0x%04x\n", len);
421
422         if (len > sizeof(features)) {
423                 info(udev, "can not get features in a single query, truncating\n");
424                 len = sizeof(features);
425         }
426
427         /* device features */
428         for (i = 8; i+4 < len; i += (4 + features[i+3])) {
429                 unsigned int feature;
430
431                 feature = features[i] << 8 | features[i+1];
432
433                 switch (feature) {
434                 case 0x00:
435                         info(udev, "GET CONFIGURATION: feature 'profiles', with %i entries\n", features[i+3] / 4);
436                         feature_profiles(udev, &features[i]+4, features[i+3]);
437                         break;
438                 default:
439                         info(udev, "GET CONFIGURATION: feature 0x%04x <ignored>, with 0x%02x bytes\n", feature, features[i+3]);
440                         break;
441                 }
442         }
443
444         cur_profile = features[6] << 8 | features[7];
445         if (cur_profile > 0) {
446                 info(udev, "current profile 0x%02x\n", cur_profile);
447         } else {
448                 info(udev, "no current profile, assuming no media\n");
449                 return -1;
450         }
451
452         switch (cur_profile) {
453         case 0x03:
454         case 0x04:
455         case 0x05:
456                 info(udev, "profile 0x%02x \n", cur_profile);
457                 cd_media = 1;
458                 cd_media_mo = 1;
459                 break;
460         case 0x08:
461                 info(udev, "profile 0x%02x media_cd_rom\n", cur_profile);
462                 cd_media = 1;
463                 cd_media_cd_rom = 1;
464                 break;
465         case 0x09:
466                 info(udev, "profile 0x%02x media_cd_r\n", cur_profile);
467                 cd_media = 1;
468                 cd_media_cd_r = 1;
469                 break;
470         case 0x0a:
471                 info(udev, "profile 0x%02x media_cd_rw\n", cur_profile);
472                 cd_media = 1;
473                 cd_media_cd_rw = 1;
474                 break;
475         case 0x10:
476                 info(udev, "profile 0x%02x media_dvd_ro\n", cur_profile);
477                 cd_media = 1;
478                 cd_media_dvd_rom = 1;
479                 break;
480         case 0x11:
481                 info(udev, "profile 0x%02x media_dvd_r\n", cur_profile);
482                 cd_media = 1;
483                 cd_media_dvd_r = 1;
484                 break;
485         case 0x12:
486                 info(udev, "profile 0x%02x media_dvd_ram\n", cur_profile);
487                 cd_media = 1;
488                 cd_media_dvd_ram = 1;
489                 break;
490         case 0x13:
491         case 0x14:
492                 info(udev, "profile 0x%02x media_dvd_rw\n", cur_profile);
493                 cd_media = 1;
494                 cd_media_dvd_rw = 1;
495                 break;
496         case 0x1B:
497                 info(udev, "profile 0x%02x media_dvd_plus_r\n", cur_profile);
498                 cd_media = 1;
499                 cd_media_dvd_plus_r = 1;
500                 break;
501         case 0x1A:
502                 info(udev, "profile 0x%02x media_dvd_plus_rw\n", cur_profile);
503                 cd_media = 1;
504                 cd_media_dvd_plus_rw = 1;
505                 break;
506         case 0x2A:
507                 info(udev, "profile 0x%02x media_dvd_plus_rw_dl\n", cur_profile);
508                 cd_media = 1;
509                 cd_media_dvd_plus_rw_dl = 1;
510                 break;
511         case 0x2B:
512                 info(udev, "profile 0x%02x media_dvd_plus_r_dl\n", cur_profile);
513                 cd_media = 1;
514                 cd_media_dvd_plus_r_dl = 1;
515                 break;
516         case 0x40:
517                 info(udev, "profile 0x%02x media_bd\n", cur_profile);
518                 cd_media = 1;
519                 cd_media_bd = 1;
520                 break;
521         case 0x41:
522         case 0x42:
523                 info(udev, "profile 0x%02x media_bd_r\n", cur_profile);
524                 cd_media = 1;
525                 cd_media_bd_r = 1;
526                 break;
527         case 0x43:
528                 info(udev, "profile 0x%02x media_bd_re\n", cur_profile);
529                 cd_media = 1;
530                 cd_media_bd_re = 1;
531                 break;
532         case 0x50:
533                 info(udev, "profile 0x%02x media_hddvd\n", cur_profile);
534                 cd_media = 1;
535                 cd_media_hddvd = 1;
536                 break;
537         case 0x51:
538                 info(udev, "profile 0x%02x media_hddvd_r\n", cur_profile);
539                 cd_media = 1;
540                 cd_media_hddvd_r = 1;
541                 break;
542         case 0x52:
543                 info(udev, "profile 0x%02x media_hddvd_rw\n", cur_profile);
544                 cd_media = 1;
545                 cd_media_hddvd_rw = 1;
546                 break;
547         default:
548                 info(udev, "profile 0x%02x <ignored>\n", cur_profile);
549                 break;
550         }
551         return 0;
552 }
553
554 static int cd_media_info(struct udev *udev, int fd)
555 {
556         struct scsi_cmd sc;
557         unsigned char header[32];
558         static const char *media_status[] = {
559                 "blank",
560                 "appendable",
561                 "complete",
562                 "other"
563         };
564         int err;
565
566         scsi_cmd_init(udev, &sc, header, sizeof(header));
567         scsi_cmd_set(udev, &sc, 0, 0x51);
568         scsi_cmd_set(udev, &sc, 8, sizeof(header) & 0xff);
569         scsi_cmd_set(udev, &sc, 9, 0);
570         err = scsi_cmd_run(udev, &sc, fd, header, sizeof(header));
571         if ((err != 0)) {
572                 info_scsi_cmd_err(udev, "READ DISC INFORMATION", err);
573                 return -1;
574         };
575
576         cd_media = 1;
577         info(udev, "disk type %02x\n", header[8]);
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[17 * 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, 17);
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 either */
695         if ((header[2] & 3) < 2)
696                 cd_media_session_next = header[10] << 8 | header[5];
697         cd_media_session_count = header[9] << 8 | header[4];
698         cd_media_track_count = header[11] << 8 | header[6];
699
700         return 0;
701 }
702
703 static int cd_media_toc(struct udev *udev, int fd)
704 {
705         struct scsi_cmd sc;
706         unsigned char header[12];
707         unsigned char toc[2048];
708         unsigned int len, i;
709         unsigned char *p;
710         int err;
711
712         scsi_cmd_init(udev, &sc, header, sizeof(header));
713         scsi_cmd_set(udev, &sc, 0, 0x43);
714         scsi_cmd_set(udev, &sc, 6, 1);
715         scsi_cmd_set(udev, &sc, 8, sizeof(header) & 0xff);
716         scsi_cmd_set(udev, &sc, 9, 0);
717         err = scsi_cmd_run(udev, &sc, fd, header, sizeof(header));
718         if ((err != 0)) {
719                 info_scsi_cmd_err(udev, "READ TOC", err);
720                 return -1;
721         }
722
723         len = (header[0] << 8 | header[1]) + 2;
724         info(udev, "READ TOC: len: %d\n", len);
725         if (len > sizeof(toc))
726                 return -1;
727         if (len < 2)
728                 return -1;
729
730         /* empty media has no tracks */
731         if (len < 8)
732                 return 0;
733
734         scsi_cmd_init(udev, &sc, toc, sizeof(toc));
735         scsi_cmd_set(udev, &sc, 0, 0x43);
736         scsi_cmd_set(udev, &sc, 6, header[2]); /* First Track/Session Number */
737         scsi_cmd_set(udev, &sc, 7, (len >> 8) & 0xff);
738         scsi_cmd_set(udev, &sc, 8, len & 0xff);
739         scsi_cmd_set(udev, &sc, 9, 0);
740         err = scsi_cmd_run(udev, &sc, fd, toc, len);
741         if ((err != 0)) {
742                 info_scsi_cmd_err(udev, "READ TOC (tracks)", err);
743                 return -1;
744         }
745
746         for (p = toc+4, i = 4; i < len-8; i += 8, p += 8) {
747                 unsigned int block;
748                 unsigned int is_data_track;
749
750                 is_data_track = (p[1] & 0x04) != 0;
751
752                 block = p[4] << 24 | p[5] << 16 | p[6] << 8 | p[7];
753                 info(udev, "track=%u info=0x%x(%s) start_block=%u\n",
754                      p[2], p[1] & 0x0f, is_data_track ? "data":"audio", block);
755
756                 if (is_data_track)
757                         cd_media_track_count_data++;
758                 else
759                         cd_media_track_count_audio++;
760         }
761
762         scsi_cmd_init(udev, &sc, header, sizeof(header));
763         scsi_cmd_set(udev, &sc, 0, 0x43);
764         scsi_cmd_set(udev, &sc, 2, 1); /* Session Info */
765         scsi_cmd_set(udev, &sc, 8, sizeof(header));
766         scsi_cmd_set(udev, &sc, 9, 0);
767         err = scsi_cmd_run(udev, &sc, fd, header, sizeof(header));
768         if ((err != 0)) {
769                 info_scsi_cmd_err(udev, "READ TOC (multi session)", err);
770                 return -1;
771         }
772         len = header[4+4] << 24 | header[4+5] << 16 | header[4+6] << 8 | header[4+7];
773         info(udev, "last track %u starts at block %u\n", header[4+2], len);
774         cd_media_session_last_offset = (unsigned long long int)len * 2048;
775         return 0;
776 }
777
778 int main(int argc, char *argv[])
779 {
780         struct udev *udev;
781         static const struct option options[] = {
782                 { "export", no_argument, NULL, 'x' },
783                 { "debug", no_argument, NULL, 'd' },
784                 { "help", no_argument, NULL, 'h' },
785                 {}
786         };
787         const char *node = NULL;
788         int export = 0;
789         int fd = -1;
790         int cnt;
791         int rc = 0;
792
793         udev = udev_new();
794         if (udev == NULL)
795                 goto exit;
796
797         udev_log_init("cdrom_id");
798         udev_set_log_fn(udev, log_fn);
799
800         while (1) {
801                 int option;
802
803                 option = getopt_long(argc, argv, "dxh", options, NULL);
804                 if (option == -1)
805                         break;
806
807                 switch (option) {
808                 case 'd':
809                         debug = 1;
810                         if (udev_get_log_priority(udev) < LOG_INFO)
811                                 udev_set_log_priority(udev, LOG_INFO);
812                         break;
813                 case 'x':
814                         export = 1;
815                         break;
816                 case 'h':
817                         printf("Usage: cdrom_id [options] <device>\n"
818                                "  --export        export key/value pairs\n"
819                                "  --debug         debug to stderr\n"
820                                "  --help          print this help text\n\n");
821                         goto exit;
822                 default:
823                         rc = 1;
824                         goto exit;
825                 }
826         }
827
828         node = argv[optind];
829         if (!node) {
830                 err(udev, "no device\n");
831                 fprintf(stderr, "no device\n");
832                 rc = 1;
833                 goto exit;
834         }
835
836         srand((unsigned int)getpid());
837         for (cnt = 20; cnt > 0; cnt--) {
838                 struct timespec duration;
839
840                 fd = open(node, O_RDONLY|O_NONBLOCK|(is_mounted(node) ? 0 : O_EXCL));
841                 if (fd >= 0 || errno != EBUSY)
842                         break;
843                 duration.tv_sec = 0;
844                 duration.tv_nsec = (100 * 1000 * 1000) + (rand() % 100 * 1000 * 1000);
845                 nanosleep(&duration, NULL);
846         }
847         if (fd < 0) {
848                 info(udev, "unable to open '%s'\n", node);
849                 fprintf(stderr, "unable to open '%s'\n", node);
850                 rc = 1;
851                 goto exit;
852         }
853         info(udev, "probing: '%s'\n", node);
854
855         /* same data as original cdrom_id */
856         if (cd_capability_compat(udev, fd) < 0) {
857                 rc = 1;
858                 goto exit;
859         }
860
861         /* check for media - don't bail if there's no media as we still need to
862          * to read profiles */
863         cd_media_compat(udev, fd);
864
865         /* check if drive talks MMC */
866         if (cd_inquiry(udev, fd) < 0)
867                 goto print;
868
869         /* read drive and possibly current profile */
870         if (cd_profiles(udev, fd) < 0)
871                 goto print;
872
873         /* get writable media state */
874         if (cd_media_info(udev, fd) < 0)
875                 goto print;
876
877         /* get session/track info */
878         if (cd_media_toc(udev, fd) < 0)
879                 goto print;
880
881 print:
882         printf("ID_CDROM=1\n");
883         if (cd_cd_rom)
884                 printf("ID_CDROM_CD=1\n");
885         if (cd_cd_r)
886                 printf("ID_CDROM_CD_R=1\n");
887         if (cd_cd_rw)
888                 printf("ID_CDROM_CD_RW=1\n");
889         if (cd_dvd_rom)
890                 printf("ID_CDROM_DVD=1\n");
891         if (cd_dvd_r)
892                 printf("ID_CDROM_DVD_R=1\n");
893         if (cd_dvd_rw)
894                 printf("ID_CDROM_DVD_RW=1\n");
895         if (cd_dvd_ram)
896                 printf("ID_CDROM_DVD_RAM=1\n");
897         if (cd_dvd_plus_r)
898                 printf("ID_CDROM_DVD_PLUS_R=1\n");
899         if (cd_dvd_plus_rw)
900                 printf("ID_CDROM_DVD_PLUS_RW=1\n");
901         if (cd_dvd_plus_r_dl)
902                 printf("ID_CDROM_DVD_PLUS_R_DL=1\n");
903         if (cd_dvd_plus_rw_dl)
904                 printf("ID_CDROM_DVD_PLUS_RW_DL=1\n");
905         if (cd_bd)
906                 printf("ID_CDROM_BD=1\n");
907         if (cd_bd_r)
908                 printf("ID_CDROM_BD_R=1\n");
909         if (cd_bd_re)
910                 printf("ID_CDROM_BD_RE=1\n");
911         if (cd_hddvd)
912                 printf("ID_CDROM_HDDVD=1\n");
913         if (cd_hddvd_r)
914                 printf("ID_CDROM_HDDVD_R=1\n");
915         if (cd_hddvd_rw)
916                 printf("ID_CDROM_HDDVD_RW=1\n");
917         if (cd_mo)
918                 printf("ID_CDROM_MO=1\n");
919         if (cd_mrw)
920                 printf("ID_CDROM_MRW=1\n");
921         if (cd_mrw_w)
922                 printf("ID_CDROM_MRW_W=1\n");
923
924         if (cd_media)
925                 printf("ID_CDROM_MEDIA=1\n");
926         if (cd_media_mo)
927                 printf("ID_CDROM_MEDIA_MO=1\n");
928         if (cd_media_mrw)
929                 printf("ID_CDROM_MEDIA_MRW=1\n");
930         if (cd_media_mrw_w)
931                 printf("ID_CDROM_MEDIA_MRW_W=1\n");
932         if (cd_media_cd_rom)
933                 printf("ID_CDROM_MEDIA_CD=1\n");
934         if (cd_media_cd_r)
935                 printf("ID_CDROM_MEDIA_CD_R=1\n");
936         if (cd_media_cd_rw)
937                 printf("ID_CDROM_MEDIA_CD_RW=1\n");
938         if (cd_media_dvd_rom)
939                 printf("ID_CDROM_MEDIA_DVD=1\n");
940         if (cd_media_dvd_r)
941                 printf("ID_CDROM_MEDIA_DVD_R=1\n");
942         if (cd_media_dvd_ram)
943                 printf("ID_CDROM_MEDIA_DVD_RAM=1\n");
944         if (cd_media_dvd_rw)
945                 printf("ID_CDROM_MEDIA_DVD_RW=1\n");
946         if (cd_media_dvd_plus_r)
947                 printf("ID_CDROM_MEDIA_DVD_PLUS_R=1\n");
948         if (cd_media_dvd_plus_rw)
949                 printf("ID_CDROM_MEDIA_DVD_PLUS_RW=1\n");
950         if (cd_media_dvd_plus_rw_dl)
951                 printf("ID_CDROM_MEDIA_DVD_PLUS_RW_DL=1\n");
952         if (cd_media_dvd_plus_r_dl)
953                 printf("ID_CDROM_MEDIA_DVD_PLUS_R_DL=1\n");
954         if (cd_media_bd)
955                 printf("ID_CDROM_MEDIA_BD=1\n");
956         if (cd_media_bd_r)
957                 printf("ID_CDROM_MEDIA_BD_R=1\n");
958         if (cd_media_bd_re)
959                 printf("ID_CDROM_MEDIA_BD_RE=1\n");
960         if (cd_media_hddvd)
961                 printf("ID_CDROM_MEDIA_HDDVD=1\n");
962         if (cd_media_hddvd_r)
963                 printf("ID_CDROM_MEDIA_HDDVD_R=1\n");
964         if (cd_media_hddvd_rw)
965                 printf("ID_CDROM_MEDIA_HDDVD_RW=1\n");
966
967         if (cd_media_state != NULL)
968                 printf("ID_CDROM_MEDIA_STATE=%s\n", cd_media_state);
969         if (cd_media_session_next > 0)
970                 printf("ID_CDROM_MEDIA_SESSION_NEXT=%d\n", cd_media_session_next);
971         if (cd_media_session_count > 0)
972                 printf("ID_CDROM_MEDIA_SESSION_COUNT=%d\n", cd_media_session_count);
973         if (cd_media_session_count > 1 && cd_media_session_last_offset > 0)
974                 printf("ID_CDROM_MEDIA_SESSION_LAST_OFFSET=%llu\n", cd_media_session_last_offset);
975         if (cd_media_track_count > 0)
976                 printf("ID_CDROM_MEDIA_TRACK_COUNT=%d\n", cd_media_track_count);
977         if (cd_media_track_count_audio > 0)
978                 printf("ID_CDROM_MEDIA_TRACK_COUNT_AUDIO=%d\n", cd_media_track_count_audio);
979         if (cd_media_track_count_data > 0)
980                 printf("ID_CDROM_MEDIA_TRACK_COUNT_DATA=%d\n", cd_media_track_count_data);
981 exit:
982         if (fd >= 0)
983                 close(fd);
984         udev_unref(udev);
985         udev_log_close();
986         return rc;
987 }
988