cregit-Linux how code gets into the kernel

Release 4.11 drivers/ata/libata-zpodd.c

Directory: drivers/ata
#include <linux/libata.h>
#include <linux/cdrom.h>
#include <linux/pm_runtime.h>
#include <linux/module.h>
#include <linux/pm_qos.h>
#include <scsi/scsi_device.h>

#include "libata.h"


static int zpodd_poweroff_delay = 30; 
/* 30 seconds for power off delay */
module_param(zpodd_poweroff_delay, int, 0644);
MODULE_PARM_DESC(zpodd_poweroff_delay, "Poweroff delay for ZPODD in seconds");


enum odd_mech_type {
	
ODD_MECH_TYPE_SLOT,
	
ODD_MECH_TYPE_DRAWER,
	
ODD_MECH_TYPE_UNSUPPORTED,
};


struct zpodd {
	
enum odd_mech_type	mech_type; /* init during probe, RO afterwards */
	
struct ata_device	*dev;

	/* The following fields are synchronized by PM core. */
	
bool			from_notify; /* resumed as a result of
                                              * acpi wake notification */
	
bool			zp_ready; /* ZP ready state */
	
unsigned long		last_ready; /* last ZP ready timestamp */
	
bool			zp_sampled; /* ZP ready state sampled */
	
bool			powered_off; /* ODD is powered off
                                              * during suspend */
};


static int eject_tray(struct ata_device *dev) { struct ata_taskfile tf; const char cdb[] = { GPCMD_START_STOP_UNIT, 0, 0, 0, 0x02, /* LoEj */ 0, 0, 0, 0, 0, 0, 0, }; ata_tf_init(dev, &tf); tf.flags = ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE; tf.command = ATA_CMD_PACKET; tf.protocol = ATAPI_PROT_NODATA; return ata_exec_internal(dev, &tf, cdb, DMA_NONE, NULL, 0, 0); }

Contributors

PersonTokensPropCommitsCommitProp
Aaron Lu8691.49%150.00%
Sergei Shtylyov88.51%150.00%
Total94100.00%2100.00%

/* Per the spec, only slot type and drawer type ODD can be supported */
static enum odd_mech_type zpodd_get_mech_type(struct ata_device *dev) { char buf[16]; unsigned int ret; struct rm_feature_desc *desc = (void *)(buf + 8); struct ata_taskfile tf; char cdb[] = { GPCMD_GET_CONFIGURATION, 2, /* only 1 feature descriptor requested */ 0, 3, /* 3, removable medium feature */ 0, 0, 0,/* reserved */ 0, sizeof(buf), 0, 0, 0, }; ata_tf_init(dev, &tf); tf.flags = ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE; tf.command = ATA_CMD_PACKET; tf.protocol = ATAPI_PROT_PIO; tf.lbam = sizeof(buf); ret = ata_exec_internal(dev, &tf, cdb, DMA_FROM_DEVICE, buf, sizeof(buf), 0); if (ret) return ODD_MECH_TYPE_UNSUPPORTED; if (be16_to_cpu(desc->feature_code) != 3) return ODD_MECH_TYPE_UNSUPPORTED; if (desc->mech_type == 0 && desc->load == 0 && desc->eject == 1) return ODD_MECH_TYPE_SLOT; else if (desc->mech_type == 1 && desc->load == 0 && desc->eject == 1) return ODD_MECH_TYPE_DRAWER; else return ODD_MECH_TYPE_UNSUPPORTED; }

Contributors

PersonTokensPropCommitsCommitProp
Aaron Lu20196.17%150.00%
Sergei Shtylyov83.83%150.00%
Total209100.00%2100.00%

/* Test if ODD is zero power ready by sense code */
static bool zpready(struct ata_device *dev) { u8 sense_key, *sense_buf; unsigned int ret, asc, ascq, add_len; struct zpodd *zpodd = dev->zpodd; ret = atapi_eh_tur(dev, &sense_key); if (!ret || sense_key != NOT_READY) return false; sense_buf = dev->link->ap->sector_buf; ret = atapi_eh_request_sense(dev, sense_buf, sense_key); if (ret) return false; /* sense valid */ if ((sense_buf[0] & 0x7f) != 0x70) return false; add_len = sense_buf[7]; /* has asc and ascq */ if (add_len < 6) return false; asc = sense_buf[12]; ascq = sense_buf[13]; if (zpodd->mech_type == ODD_MECH_TYPE_SLOT) /* no media inside */ return asc == 0x3a; else /* no media inside and door closed */ return asc == 0x3a && ascq == 0x01; }

Contributors

PersonTokensPropCommitsCommitProp
Aaron Lu159100.00%1100.00%
Total159100.00%1100.00%

/* * Update the zpodd->zp_ready field. This field will only be set * if the ODD has stayed in ZP ready state for zpodd_poweroff_delay * time, and will be used to decide if power off is allowed. If it * is set, it will be cleared during resume from powered off state. */
void zpodd_on_suspend(struct ata_device *dev) { struct zpodd *zpodd = dev->zpodd; unsigned long expires; if (!zpready(dev)) { zpodd->zp_sampled = false; zpodd->zp_ready = false; return; } if (!zpodd->zp_sampled) { zpodd->zp_sampled = true; zpodd->last_ready = jiffies; return; } expires = zpodd->last_ready + msecs_to_jiffies(zpodd_poweroff_delay * 1000); if (time_before(jiffies, expires)) return; zpodd->zp_ready = true; }

Contributors

PersonTokensPropCommitsCommitProp
Aaron Lu97100.00%2100.00%
Total97100.00%2100.00%


bool zpodd_zpready(struct ata_device *dev) { struct zpodd *zpodd = dev->zpodd; return zpodd->zp_ready; }

Contributors

PersonTokensPropCommitsCommitProp
Aaron Lu24100.00%1100.00%
Total24100.00%1100.00%

/* * Enable runtime wake capability through ACPI and set the powered_off flag, * this flag will be used during resume to decide what operations are needed * to take. * * Also, media poll needs to be silenced, so that it doesn't bring the ODD * back to full power state every few seconds. */
void zpodd_enable_run_wake(struct ata_device *dev) { struct zpodd *zpodd = dev->zpodd; sdev_disable_disk_events(dev->sdev); zpodd->powered_off = true; device_set_run_wake(&dev->tdev, true); acpi_pm_device_run_wake(&dev->tdev, true); }

Contributors

PersonTokensPropCommitsCommitProp
Aaron Lu52100.00%3100.00%
Total52100.00%3100.00%

/* Disable runtime wake capability if it is enabled */
void zpodd_disable_run_wake(struct ata_device *dev) { struct zpodd *zpodd = dev->zpodd; if (zpodd->powered_off) { acpi_pm_device_run_wake(&dev->tdev, false); device_set_run_wake(&dev->tdev, false); } }

Contributors

PersonTokensPropCommitsCommitProp
Aaron Lu47100.00%2100.00%
Total47100.00%2100.00%

/* * Post power on processing after the ODD has been recovered. If the * ODD wasn't powered off during suspend, it doesn't do anything. * * For drawer type ODD, if it is powered on due to user pressed the * eject button, the tray needs to be ejected. This can only be done * after the ODD has been recovered, i.e. link is initialized and * device is able to process NON_DATA PIO command, as eject needs to * send command for the ODD to process. * * The from_notify flag set in wake notification handler function * zpodd_wake_dev represents if power on is due to user's action. * * For both types of ODD, several fields need to be reset. */
void zpodd_post_poweron(struct ata_device *dev) { struct zpodd *zpodd = dev->zpodd; if (!zpodd->powered_off) return; zpodd->powered_off = false; if (zpodd->from_notify) { zpodd->from_notify = false; if (zpodd->mech_type == ODD_MECH_TYPE_DRAWER) eject_tray(dev); } zpodd->zp_sampled = false; zpodd->zp_ready = false; sdev_enable_disk_events(dev->sdev); }

Contributors

PersonTokensPropCommitsCommitProp
Aaron Lu79100.00%2100.00%
Total79100.00%2100.00%


static void zpodd_wake_dev(acpi_handle handle, u32 event, void *context) { struct ata_device *ata_dev = context; struct zpodd *zpodd = ata_dev->zpodd; struct device *dev = &ata_dev->sdev->sdev_gendev; if (event == ACPI_NOTIFY_DEVICE_WAKE && pm_runtime_suspended(dev)) { zpodd->from_notify = true; pm_runtime_resume(dev); } }

Contributors

PersonTokensPropCommitsCommitProp
Aaron Lu68100.00%1100.00%
Total68100.00%1100.00%


static void ata_acpi_add_pm_notifier(struct ata_device *dev) { acpi_handle handle = ata_dev_acpi_handle(dev); acpi_install_notify_handler(handle, ACPI_SYSTEM_NOTIFY, zpodd_wake_dev, dev); }

Contributors

PersonTokensPropCommitsCommitProp
Aaron Lu30100.00%1100.00%
Total30100.00%1100.00%


static void ata_acpi_remove_pm_notifier(struct ata_device *dev) { acpi_handle handle = ata_dev_acpi_handle(dev); acpi_remove_notify_handler(handle, ACPI_SYSTEM_NOTIFY, zpodd_wake_dev); }

Contributors

PersonTokensPropCommitsCommitProp
Aaron Lu28100.00%2100.00%
Total28100.00%2100.00%


void zpodd_init(struct ata_device *dev) { struct acpi_device *adev = ACPI_COMPANION(&dev->tdev); enum odd_mech_type mech_type; struct zpodd *zpodd; if (dev->zpodd || !adev || !acpi_device_can_poweroff(adev)) return; mech_type = zpodd_get_mech_type(dev); if (mech_type == ODD_MECH_TYPE_UNSUPPORTED) return; zpodd = kzalloc(sizeof(struct zpodd), GFP_KERNEL); if (!zpodd) return; zpodd->mech_type = mech_type; ata_acpi_add_pm_notifier(dev); zpodd->dev = dev; dev->zpodd = zpodd; dev_pm_qos_expose_flags(&dev->tdev, 0); }

Contributors

PersonTokensPropCommitsCommitProp
Aaron Lu114100.00%4100.00%
Total114100.00%4100.00%


void zpodd_exit(struct ata_device *dev) { ata_acpi_remove_pm_notifier(dev); kfree(dev->zpodd); dev->zpodd = NULL; }

Contributors

PersonTokensPropCommitsCommitProp
Aaron Lu28100.00%2100.00%
Total28100.00%2100.00%


Overall Contributors

PersonTokensPropCommitsCommitProp
Aaron Lu111098.58%888.89%
Sergei Shtylyov161.42%111.11%
Total1126100.00%9100.00%
Directory: drivers/ata
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.