diff options
| -rw-r--r-- | toys/other/eject.c | 79 |
1 files changed, 34 insertions, 45 deletions
diff --git a/toys/other/eject.c b/toys/other/eject.c index 279f7a31..31eab144 100644 --- a/toys/other/eject.c +++ b/toys/other/eject.c @@ -2,7 +2,8 @@ * * Copyright 2012 Harvind Singh <harvindsingh1981@gmail.com> * Copyright 2013 Kyungwan Han <asura321@gamil.com> - * Not in SUSv4. + * + * No standard. USE_EJECT(NEWTOY(eject, ">1stT[!tT]", TOYFLAG_USR|TOYFLAG_BIN)) @@ -10,13 +11,13 @@ config EJECT bool "eject" default y help - usage: eject [-s] [-t] [-T] [...] + usage: eject [-stT] [DEVICE] Eject DEVICE or default /dev/cdrom - -s SCSI device - -t Close tray - -T Open/close tray (toggle). + -s SCSI device + -t Close tray + -T Open/close tray (toggle). */ #define FOR_eject @@ -24,44 +25,32 @@ config EJECT #include <scsi/sg.h> #include <scsi/scsi.h> -#define CDROM_DRIVE_STATUS 0x5326 //Get tray position, etc. -#define CDROM_CLOSE_TRAY 0x5319 //Pendant of CDROM_EJECT. -#define CDROM_EJECT 0x5309 //Ejects the cdrom media. -#define DRIVE_NOT_READY 3 //Drive is busy. - -/* - * Remove SCSI Device. - */ -static void remove_scsi(int dscptr) +// The SCSI way of requesting eject +static void remove_scsi(int fd) { + unsigned i; + sg_io_hdr_t *header = (sg_io_hdr_t *)(toybuf+64); char sg_driver_cmd[3][6] = { - { ALLOW_MEDIUM_REMOVAL, 0, 0, 0, 0, 0 }, //allow medium removal + { ALLOW_MEDIUM_REMOVAL, 0, 0, 0, 0, 0 }, { START_STOP, 0, 0, 0, 1, 0 }, //start the motor { START_STOP, 0, 0, 0, 2, 0 } //eject the media }; - unsigned i; - unsigned char buffer1[32],buffer2[2]; - sg_io_hdr_t in_out_header; - - if ((ioctl(dscptr, SG_GET_VERSION_NUM, &i) < 0) || (i < 30000)) - error_exit("not a sg device or old sg driver"); - - memset(&in_out_header, 0, sizeof(sg_io_hdr_t)); - in_out_header.interface_id = 'S'; - in_out_header.cmd_len = 6; - in_out_header.mx_sb_len = sizeof(buffer1); - in_out_header.dxfer_direction = SG_DXFER_NONE; - in_out_header.dxferp = buffer2; - in_out_header.sbp = buffer1; - in_out_header.timeout = 2000; + header->interface_id = 'S'; + header->cmd_len = 6; + header->mx_sb_len = 32; + header->dxfer_direction = SG_DXFER_NONE; + header->dxferp = toybuf + 32; + header->sbp = (void *)toybuf; + header->timeout = 2000; for (i = 0; i < 3; i++) { - in_out_header.cmdp = (void *)sg_driver_cmd[i]; - xioctl(dscptr, SG_IO, (void *)&in_out_header); + header->cmdp = (void *)sg_driver_cmd[i]; + xioctl(fd, SG_IO, (void *)header); } - /* force kernel to reread partition table when new disc is inserted */ - ioctl(dscptr, BLKRRPART); + + // force kernel to reread partition table when new disc is inserted + ioctl(fd, BLKRRPART); } /* @@ -69,21 +58,21 @@ static void remove_scsi(int dscptr) */ void eject_main(void) { - int fd, out = 0, rc = 0; - char *device_name; - if (!toys.optc) device_name = "/dev/cdrom"; - else device_name = toys.optargs[0]; + int fd, out = 0; + char *device_name = "/dev/cdrom"; + + if (*toys.optargs) device_name = *toys.optargs; fd = xopen(device_name, O_RDONLY | O_NONBLOCK); - if (!toys.optflags) xioctl(fd, CDROM_EJECT, &out); + if (!toys.optflags) xioctl(fd, 0x5309, &out); // CDROM_EJECT else if (toys.optflags & FLAG_s) remove_scsi(fd); else { - if (toys.optflags & FLAG_T || toys.optflags & FLAG_t) { - rc = ioctl(fd, CDROM_DRIVE_STATUS, &out); - if (toys.optflags & FLAG_t || rc == 2) //CDS_TRAY_OPEN = 2 - xioctl(fd, CDROM_CLOSE_TRAY, &out); - else xioctl(fd, CDROM_EJECT, &out); + if ((toys.optflags & FLAG_T) || (toys.optflags & FLAG_t)) { + int rc = ioctl(fd, 0x5326, &out); // CDROM_DRIVE_STATUS + if ((toys.optflags & FLAG_t) || rc == 2) // CDS_TRAY_OPEN + xioctl(fd, 0x5319, &out); // CDROM_CLOSE_TRAY + else xioctl(fd, 0x5309, &out); // CDROM_EJECT } } - xclose(fd); + if (CFG_TOYBOX_FREE) xclose(fd); } |