1 /* eject.c - eject device. 2 * 3 * Copyright 2012 Harvind Singh <harvindsingh1981@gmail.com> 4 * Copyright 2013 Kyungwan Han <asura321@gamil.com> 5 * 6 * No standard. 7 8 USE_EJECT(NEWTOY(eject, ">1stT[!tT]", TOYFLAG_USR|TOYFLAG_BIN)) 9 10 config EJECT 11 bool "eject" 12 default y 13 help 14 usage: eject [-stT] [DEVICE] 15 16 Eject DEVICE or default /dev/cdrom 17 18 -s SCSI device 19 -t Close tray 20 -T Open/close tray (toggle) 21 */ 22 23 #define FOR_eject 24 #include "toys.h" 25 #include <scsi/sg.h> 26 #include <scsi/scsi.h> 27 28 // The SCSI way of requesting eject remove_scsi(int fd)29 static void remove_scsi(int fd) 30 { 31 unsigned i; 32 sg_io_hdr_t *header = (sg_io_hdr_t *)(toybuf+64); 33 char sg_driver_cmd[3][6] = { 34 { ALLOW_MEDIUM_REMOVAL, 0, 0, 0, 0, 0 }, 35 { START_STOP, 0, 0, 0, 1, 0 }, //start the motor 36 { START_STOP, 0, 0, 0, 2, 0 } //eject the media 37 }; 38 39 header->interface_id = 'S'; 40 header->cmd_len = 6; 41 header->mx_sb_len = 32; 42 header->dxfer_direction = SG_DXFER_NONE; 43 header->dxferp = toybuf + 32; 44 header->sbp = (void *)toybuf; 45 header->timeout = 2000; 46 47 for (i = 0; i < 3; i++) { 48 header->cmdp = (void *)sg_driver_cmd[i]; 49 xioctl(fd, SG_IO, (void *)header); 50 } 51 52 // force kernel to reread partition table when new disc is inserted 53 ioctl(fd, BLKRRPART); 54 } 55 56 /* 57 * eject main function. 58 */ eject_main(void)59 void eject_main(void) 60 { 61 int fd, out = 0; 62 char *device_name = "/dev/cdrom"; 63 64 if (*toys.optargs) device_name = *toys.optargs; 65 66 fd = xopen(device_name, O_RDONLY | O_NONBLOCK); 67 if (!toys.optflags) xioctl(fd, 0x5309, &out); // CDROM_EJECT 68 else if (toys.optflags & FLAG_s) remove_scsi(fd); 69 else { 70 if ((toys.optflags & FLAG_T) || (toys.optflags & FLAG_t)) { 71 int rc = ioctl(fd, 0x5326, &out); // CDROM_DRIVE_STATUS 72 if ((toys.optflags & FLAG_t) || rc == 2) // CDS_TRAY_OPEN 73 xioctl(fd, 0x5319, &out); // CDROM_CLOSE_TRAY 74 else xioctl(fd, 0x5309, &out); // CDROM_EJECT 75 } 76 } 77 if (CFG_TOYBOX_FREE) xclose(fd); 78 } 79