|  | // SPDX-License-Identifier: GPL-2.0-only | 
|  | /* | 
|  | *  Copyright 2008 ioogle, Inc.  All rights reserved. | 
|  | * | 
|  | * Libata transport class. | 
|  | * | 
|  | * The ATA transport class contains common code to deal with ATA HBAs, | 
|  | * an approximated representation of ATA topologies in the driver model, | 
|  | * and various sysfs attributes to expose these topologies and management | 
|  | * interfaces to user-space. | 
|  | * | 
|  | * There are 3 objects defined in this class: | 
|  | * - ata_port | 
|  | * - ata_link | 
|  | * - ata_device | 
|  | * Each port has a link object. Each link can have up to two devices for PATA | 
|  | * and generally one for SATA. | 
|  | * If there is SATA port multiplier [PMP], 15 additional ata_link object are | 
|  | * created. | 
|  | * | 
|  | * These objects are created when the ata host is initialized and when a PMP is | 
|  | * found. They are removed only when the HBA is removed, cleaned before the | 
|  | * error handler runs. | 
|  | */ | 
|  |  | 
|  |  | 
|  | #include <linux/kernel.h> | 
|  | #include <linux/blkdev.h> | 
|  | #include <linux/spinlock.h> | 
|  | #include <linux/slab.h> | 
|  | #include <scsi/scsi_transport.h> | 
|  | #include <linux/libata.h> | 
|  | #include <linux/hdreg.h> | 
|  | #include <linux/uaccess.h> | 
|  | #include <linux/pm_runtime.h> | 
|  |  | 
|  | #include "libata.h" | 
|  | #include "libata-transport.h" | 
|  |  | 
|  | #define ATA_PORT_ATTRS		3 | 
|  | #define ATA_LINK_ATTRS		3 | 
|  | #define ATA_DEV_ATTRS		9 | 
|  |  | 
|  | struct scsi_transport_template; | 
|  | struct scsi_transport_template *ata_scsi_transport_template; | 
|  |  | 
|  | struct ata_internal { | 
|  | struct scsi_transport_template t; | 
|  |  | 
|  | struct device_attribute private_port_attrs[ATA_PORT_ATTRS]; | 
|  | struct device_attribute private_link_attrs[ATA_LINK_ATTRS]; | 
|  | struct device_attribute private_dev_attrs[ATA_DEV_ATTRS]; | 
|  |  | 
|  | struct transport_container link_attr_cont; | 
|  | struct transport_container dev_attr_cont; | 
|  |  | 
|  | /* | 
|  | * The array of null terminated pointers to attributes | 
|  | * needed by scsi_sysfs.c | 
|  | */ | 
|  | struct device_attribute *link_attrs[ATA_LINK_ATTRS + 1]; | 
|  | struct device_attribute *port_attrs[ATA_PORT_ATTRS + 1]; | 
|  | struct device_attribute *dev_attrs[ATA_DEV_ATTRS + 1]; | 
|  | }; | 
|  | #define to_ata_internal(tmpl)	container_of(tmpl, struct ata_internal, t) | 
|  |  | 
|  |  | 
|  | #define tdev_to_device(d)					\ | 
|  | container_of((d), struct ata_device, tdev) | 
|  | #define transport_class_to_dev(dev)				\ | 
|  | tdev_to_device((dev)->parent) | 
|  |  | 
|  | #define tdev_to_link(d)						\ | 
|  | container_of((d), struct ata_link, tdev) | 
|  | #define transport_class_to_link(dev)				\ | 
|  | tdev_to_link((dev)->parent) | 
|  |  | 
|  | #define tdev_to_port(d)						\ | 
|  | container_of((d), struct ata_port, tdev) | 
|  | #define transport_class_to_port(dev)				\ | 
|  | tdev_to_port((dev)->parent) | 
|  |  | 
|  | /* | 
|  | * Hack to allow attributes of the same name in different objects. | 
|  | */ | 
|  | #define ATA_DEVICE_ATTR(_prefix,_name,_mode,_show,_store) \ | 
|  | struct device_attribute device_attr_##_prefix##_##_name = \ | 
|  | __ATTR(_name,_mode,_show,_store) | 
|  |  | 
|  | #define ata_bitfield_name_match(title, table)			\ | 
|  | static ssize_t							\ | 
|  | get_ata_##title##_names(u32 table_key, char *buf)		\ | 
|  | {								\ | 
|  | char *prefix = "";					\ | 
|  | ssize_t len = 0;					\ | 
|  | int i;							\ | 
|  | \ | 
|  | for (i = 0; i < ARRAY_SIZE(table); i++) {		\ | 
|  | if (table[i].value & table_key) {		\ | 
|  | len += sprintf(buf + len, "%s%s",	\ | 
|  | prefix, table[i].name);		\ | 
|  | prefix = ", ";				\ | 
|  | }						\ | 
|  | }							\ | 
|  | len += sprintf(buf + len, "\n");			\ | 
|  | return len;						\ | 
|  | } | 
|  |  | 
|  | #define ata_bitfield_name_search(title, table)			\ | 
|  | static ssize_t							\ | 
|  | get_ata_##title##_names(u32 table_key, char *buf)		\ | 
|  | {								\ | 
|  | ssize_t len = 0;					\ | 
|  | int i;							\ | 
|  | \ | 
|  | for (i = 0; i < ARRAY_SIZE(table); i++) {		\ | 
|  | if (table[i].value == table_key) {		\ | 
|  | len += sprintf(buf + len, "%s",		\ | 
|  | table[i].name);			\ | 
|  | break;					\ | 
|  | }						\ | 
|  | }							\ | 
|  | len += sprintf(buf + len, "\n");			\ | 
|  | return len;						\ | 
|  | } | 
|  |  | 
|  | static struct { | 
|  | u32		value; | 
|  | char		*name; | 
|  | } ata_class_names[] = { | 
|  | { ATA_DEV_UNKNOWN,		"unknown" }, | 
|  | { ATA_DEV_ATA,			"ata" }, | 
|  | { ATA_DEV_ATA_UNSUP,		"ata" }, | 
|  | { ATA_DEV_ATAPI,		"atapi" }, | 
|  | { ATA_DEV_ATAPI_UNSUP,		"atapi" }, | 
|  | { ATA_DEV_PMP,			"pmp" }, | 
|  | { ATA_DEV_PMP_UNSUP,		"pmp" }, | 
|  | { ATA_DEV_SEMB,			"semb" }, | 
|  | { ATA_DEV_SEMB_UNSUP,		"semb" }, | 
|  | { ATA_DEV_ZAC,			"zac" }, | 
|  | { ATA_DEV_NONE,			"none" } | 
|  | }; | 
|  | ata_bitfield_name_search(class, ata_class_names) | 
|  |  | 
|  |  | 
|  | static struct { | 
|  | u32		value; | 
|  | char		*name; | 
|  | } ata_err_names[] = { | 
|  | { AC_ERR_DEV,			"DeviceError" }, | 
|  | { AC_ERR_HSM,			"HostStateMachineError" }, | 
|  | { AC_ERR_TIMEOUT,		"Timeout" }, | 
|  | { AC_ERR_MEDIA,			"MediaError" }, | 
|  | { AC_ERR_ATA_BUS,		"BusError" }, | 
|  | { AC_ERR_HOST_BUS,		"HostBusError" }, | 
|  | { AC_ERR_SYSTEM,		"SystemError" }, | 
|  | { AC_ERR_INVALID,		"InvalidArg" }, | 
|  | { AC_ERR_OTHER,			"Unknown" }, | 
|  | { AC_ERR_NODEV_HINT,		"NoDeviceHint" }, | 
|  | { AC_ERR_NCQ,			"NCQError" } | 
|  | }; | 
|  | ata_bitfield_name_match(err, ata_err_names) | 
|  |  | 
|  | static struct { | 
|  | u32		value; | 
|  | char		*name; | 
|  | } ata_xfer_names[] = { | 
|  | { XFER_UDMA_7,			"XFER_UDMA_7" }, | 
|  | { XFER_UDMA_6,			"XFER_UDMA_6" }, | 
|  | { XFER_UDMA_5,			"XFER_UDMA_5" }, | 
|  | { XFER_UDMA_4,			"XFER_UDMA_4" }, | 
|  | { XFER_UDMA_3,			"XFER_UDMA_3" }, | 
|  | { XFER_UDMA_2,			"XFER_UDMA_2" }, | 
|  | { XFER_UDMA_1,			"XFER_UDMA_1" }, | 
|  | { XFER_UDMA_0,			"XFER_UDMA_0" }, | 
|  | { XFER_MW_DMA_4,		"XFER_MW_DMA_4" }, | 
|  | { XFER_MW_DMA_3,		"XFER_MW_DMA_3" }, | 
|  | { XFER_MW_DMA_2,		"XFER_MW_DMA_2" }, | 
|  | { XFER_MW_DMA_1,		"XFER_MW_DMA_1" }, | 
|  | { XFER_MW_DMA_0,		"XFER_MW_DMA_0" }, | 
|  | { XFER_SW_DMA_2,		"XFER_SW_DMA_2" }, | 
|  | { XFER_SW_DMA_1,		"XFER_SW_DMA_1" }, | 
|  | { XFER_SW_DMA_0,		"XFER_SW_DMA_0" }, | 
|  | { XFER_PIO_6,			"XFER_PIO_6" }, | 
|  | { XFER_PIO_5,			"XFER_PIO_5" }, | 
|  | { XFER_PIO_4,			"XFER_PIO_4" }, | 
|  | { XFER_PIO_3,			"XFER_PIO_3" }, | 
|  | { XFER_PIO_2,			"XFER_PIO_2" }, | 
|  | { XFER_PIO_1,			"XFER_PIO_1" }, | 
|  | { XFER_PIO_0,			"XFER_PIO_0" }, | 
|  | { XFER_PIO_SLOW,		"XFER_PIO_SLOW" } | 
|  | }; | 
|  | ata_bitfield_name_search(xfer, ata_xfer_names) | 
|  |  | 
|  | /* | 
|  | * ATA Port attributes | 
|  | */ | 
|  | #define ata_port_show_simple(field, name, format_string, cast)		\ | 
|  | static ssize_t								\ | 
|  | show_ata_port_##name(struct device *dev,				\ | 
|  | struct device_attribute *attr, char *buf)		\ | 
|  | {									\ | 
|  | struct ata_port *ap = transport_class_to_port(dev);		\ | 
|  | \ | 
|  | return sysfs_emit(buf, format_string, cast ap->field);	        \ | 
|  | } | 
|  |  | 
|  | #define ata_port_simple_attr(field, name, format_string, type)		\ | 
|  | ata_port_show_simple(field, name, format_string, (type))	\ | 
|  | static DEVICE_ATTR(name, S_IRUGO, show_ata_port_##name, NULL) | 
|  |  | 
|  | ata_port_simple_attr(nr_pmp_links, nr_pmp_links, "%d\n", int); | 
|  | ata_port_simple_attr(stats.idle_irq, idle_irq, "%ld\n", unsigned long); | 
|  | /* We want the port_no sysfs attibute to start at 1 (ap->port_no starts at 0) */ | 
|  | ata_port_simple_attr(port_no + 1, port_no, "%u\n", unsigned int); | 
|  |  | 
|  | static DECLARE_TRANSPORT_CLASS(ata_port_class, | 
|  | "ata_port", NULL, NULL, NULL); | 
|  |  | 
|  | static void ata_tport_release(struct device *dev) | 
|  | { | 
|  | struct ata_port *ap = tdev_to_port(dev); | 
|  | ata_host_put(ap->host); | 
|  | } | 
|  |  | 
|  | /** | 
|  | * ata_is_port --  check if a struct device represents a ATA port | 
|  | * @dev:	device to check | 
|  | * | 
|  | * Returns: | 
|  | *	%1 if the device represents a ATA Port, %0 else | 
|  | */ | 
|  | static int ata_is_port(const struct device *dev) | 
|  | { | 
|  | return dev->release == ata_tport_release; | 
|  | } | 
|  |  | 
|  | static int ata_tport_match(struct attribute_container *cont, | 
|  | struct device *dev) | 
|  | { | 
|  | if (!ata_is_port(dev)) | 
|  | return 0; | 
|  | return &ata_scsi_transport_template->host_attrs.ac == cont; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * ata_tport_delete  --  remove ATA PORT | 
|  | * @ap:	ATA PORT to remove | 
|  | * | 
|  | * Removes the specified ATA PORT.  Remove the associated link as well. | 
|  | */ | 
|  | void ata_tport_delete(struct ata_port *ap) | 
|  | { | 
|  | struct device *dev = &ap->tdev; | 
|  |  | 
|  | ata_tlink_delete(&ap->link); | 
|  |  | 
|  | transport_remove_device(dev); | 
|  | device_del(dev); | 
|  | transport_destroy_device(dev); | 
|  | put_device(dev); | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(ata_tport_delete); | 
|  |  | 
|  | static const struct device_type ata_port_sas_type = { | 
|  | .name = ATA_PORT_TYPE_NAME, | 
|  | }; | 
|  |  | 
|  | /** ata_tport_add - initialize a transport ATA port structure | 
|  | * | 
|  | * @parent:	parent device | 
|  | * @ap:		existing ata_port structure | 
|  | * | 
|  | * Initialize a ATA port structure for sysfs.  It will be added to the device | 
|  | * tree below the device specified by @parent which could be a PCI device. | 
|  | * | 
|  | * Returns %0 on success | 
|  | */ | 
|  | int ata_tport_add(struct device *parent, | 
|  | struct ata_port *ap) | 
|  | { | 
|  | int error; | 
|  | struct device *dev = &ap->tdev; | 
|  |  | 
|  | device_initialize(dev); | 
|  | if (ap->flags & ATA_FLAG_SAS_HOST) | 
|  | dev->type = &ata_port_sas_type; | 
|  | else | 
|  | dev->type = &ata_port_type; | 
|  |  | 
|  | dev->parent = parent; | 
|  | ata_host_get(ap->host); | 
|  | dev->release = ata_tport_release; | 
|  | dev_set_name(dev, "ata%d", ap->print_id); | 
|  | transport_setup_device(dev); | 
|  | ata_acpi_bind_port(ap); | 
|  | error = device_add(dev); | 
|  | if (error) { | 
|  | goto tport_err; | 
|  | } | 
|  |  | 
|  | device_enable_async_suspend(dev); | 
|  | pm_runtime_set_active(dev); | 
|  | pm_runtime_enable(dev); | 
|  | pm_runtime_forbid(dev); | 
|  |  | 
|  | error = transport_add_device(dev); | 
|  | if (error) | 
|  | goto tport_transport_add_err; | 
|  | transport_configure_device(dev); | 
|  |  | 
|  | error = ata_tlink_add(&ap->link); | 
|  | if (error) { | 
|  | goto tport_link_err; | 
|  | } | 
|  | return 0; | 
|  |  | 
|  | tport_link_err: | 
|  | transport_remove_device(dev); | 
|  | tport_transport_add_err: | 
|  | device_del(dev); | 
|  |  | 
|  | tport_err: | 
|  | transport_destroy_device(dev); | 
|  | put_device(dev); | 
|  | return error; | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(ata_tport_add); | 
|  |  | 
|  | /** | 
|  | *     ata_port_classify - determine device type based on ATA-spec signature | 
|  | *     @ap: ATA port device on which the classification should be run | 
|  | *     @tf: ATA taskfile register set for device to be identified | 
|  | * | 
|  | *     A wrapper around ata_dev_classify() to provide additional logging | 
|  | * | 
|  | *     RETURNS: | 
|  | *     Device type, %ATA_DEV_ATA, %ATA_DEV_ATAPI, %ATA_DEV_PMP, | 
|  | *     %ATA_DEV_ZAC, or %ATA_DEV_UNKNOWN the event of failure. | 
|  | */ | 
|  | unsigned int ata_port_classify(struct ata_port *ap, | 
|  | const struct ata_taskfile *tf) | 
|  | { | 
|  | int i; | 
|  | unsigned int class = ata_dev_classify(tf); | 
|  |  | 
|  | /* Start with index '1' to skip the 'unknown' entry */ | 
|  | for (i = 1; i < ARRAY_SIZE(ata_class_names); i++) { | 
|  | if (ata_class_names[i].value == class) { | 
|  | ata_port_dbg(ap, "found %s device by sig\n", | 
|  | ata_class_names[i].name); | 
|  | return class; | 
|  | } | 
|  | } | 
|  |  | 
|  | ata_port_info(ap, "found unknown device (class %u)\n", class); | 
|  | return class; | 
|  | } | 
|  | EXPORT_SYMBOL_GPL(ata_port_classify); | 
|  |  | 
|  | /* | 
|  | * ATA device attributes | 
|  | */ | 
|  |  | 
|  | #define ata_dev_show_class(title, field)				\ | 
|  | static ssize_t								\ | 
|  | show_ata_dev_##field(struct device *dev,				\ | 
|  | struct device_attribute *attr, char *buf)		\ | 
|  | {									\ | 
|  | struct ata_device *ata_dev = transport_class_to_dev(dev);	\ | 
|  | \ | 
|  | return get_ata_##title##_names(ata_dev->field, buf);		\ | 
|  | } | 
|  |  | 
|  | #define ata_dev_attr(title, field)					\ | 
|  | ata_dev_show_class(title, field)				\ | 
|  | static DEVICE_ATTR(field, S_IRUGO, show_ata_dev_##field, NULL) | 
|  |  | 
|  | ata_dev_attr(class, class); | 
|  | ata_dev_attr(xfer, pio_mode); | 
|  | ata_dev_attr(xfer, dma_mode); | 
|  | ata_dev_attr(xfer, xfer_mode); | 
|  |  | 
|  |  | 
|  | #define ata_dev_show_simple(field, format_string, cast)			\ | 
|  | static ssize_t								\ | 
|  | show_ata_dev_##field(struct device *dev,				\ | 
|  | struct device_attribute *attr, char *buf)		\ | 
|  | {									\ | 
|  | struct ata_device *ata_dev = transport_class_to_dev(dev);	\ | 
|  | \ | 
|  | return sysfs_emit(buf, format_string, cast ata_dev->field);	\ | 
|  | } | 
|  |  | 
|  | #define ata_dev_simple_attr(field, format_string, type)		\ | 
|  | ata_dev_show_simple(field, format_string, (type))	\ | 
|  | static DEVICE_ATTR(field, S_IRUGO,			\ | 
|  | show_ata_dev_##field, NULL) | 
|  |  | 
|  | ata_dev_simple_attr(spdn_cnt, "%d\n", int); | 
|  |  | 
|  | struct ata_show_ering_arg { | 
|  | char* buf; | 
|  | int written; | 
|  | }; | 
|  |  | 
|  | static int ata_show_ering(struct ata_ering_entry *ent, void *void_arg) | 
|  | { | 
|  | struct ata_show_ering_arg* arg = void_arg; | 
|  | u64 seconds; | 
|  | u32 rem; | 
|  |  | 
|  | seconds = div_u64_rem(ent->timestamp, HZ, &rem); | 
|  | arg->written += sprintf(arg->buf + arg->written, | 
|  | "[%5llu.%09lu]", seconds, | 
|  | rem * NSEC_PER_SEC / HZ); | 
|  | arg->written += get_ata_err_names(ent->err_mask, | 
|  | arg->buf + arg->written); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static ssize_t | 
|  | show_ata_dev_ering(struct device *dev, | 
|  | struct device_attribute *attr, char *buf) | 
|  | { | 
|  | struct ata_device *ata_dev = transport_class_to_dev(dev); | 
|  | struct ata_show_ering_arg arg = { buf, 0 }; | 
|  |  | 
|  | ata_ering_map(&ata_dev->ering, ata_show_ering, &arg); | 
|  | return arg.written; | 
|  | } | 
|  |  | 
|  |  | 
|  | static DEVICE_ATTR(ering, S_IRUGO, show_ata_dev_ering, NULL); | 
|  |  | 
|  | static ssize_t | 
|  | show_ata_dev_id(struct device *dev, | 
|  | struct device_attribute *attr, char *buf) | 
|  | { | 
|  | struct ata_device *ata_dev = transport_class_to_dev(dev); | 
|  | int written = 0, i = 0; | 
|  |  | 
|  | if (ata_dev->class == ATA_DEV_PMP) | 
|  | return 0; | 
|  | for(i=0;i<ATA_ID_WORDS;i++)  { | 
|  | written += scnprintf(buf+written, 20, "%04x%c", | 
|  | ata_dev->id[i], | 
|  | ((i+1) & 7) ? ' ' : '\n'); | 
|  | } | 
|  | return written; | 
|  | } | 
|  |  | 
|  | static DEVICE_ATTR(id, S_IRUGO, show_ata_dev_id, NULL); | 
|  |  | 
|  | static ssize_t | 
|  | show_ata_dev_gscr(struct device *dev, | 
|  | struct device_attribute *attr, char *buf) | 
|  | { | 
|  | struct ata_device *ata_dev = transport_class_to_dev(dev); | 
|  | int written = 0, i = 0; | 
|  |  | 
|  | if (ata_dev->class != ATA_DEV_PMP) | 
|  | return 0; | 
|  | for(i=0;i<SATA_PMP_GSCR_DWORDS;i++)  { | 
|  | written += scnprintf(buf+written, 20, "%08x%c", | 
|  | ata_dev->gscr[i], | 
|  | ((i+1) & 3) ? ' ' : '\n'); | 
|  | } | 
|  | if (SATA_PMP_GSCR_DWORDS & 3) | 
|  | buf[written-1] = '\n'; | 
|  | return written; | 
|  | } | 
|  |  | 
|  | static DEVICE_ATTR(gscr, S_IRUGO, show_ata_dev_gscr, NULL); | 
|  |  | 
|  | static ssize_t | 
|  | show_ata_dev_trim(struct device *dev, | 
|  | struct device_attribute *attr, char *buf) | 
|  | { | 
|  | struct ata_device *ata_dev = transport_class_to_dev(dev); | 
|  | unsigned char *mode; | 
|  |  | 
|  | if (!ata_id_has_trim(ata_dev->id)) | 
|  | mode = "unsupported"; | 
|  | else if (ata_dev->quirks & ATA_QUIRK_NOTRIM) | 
|  | mode = "forced_unsupported"; | 
|  | else if (ata_dev->quirks & ATA_QUIRK_NO_NCQ_TRIM) | 
|  | mode = "forced_unqueued"; | 
|  | else if (ata_fpdma_dsm_supported(ata_dev)) | 
|  | mode = "queued"; | 
|  | else | 
|  | mode = "unqueued"; | 
|  |  | 
|  | return scnprintf(buf, 20, "%s\n", mode); | 
|  | } | 
|  |  | 
|  | static DEVICE_ATTR(trim, S_IRUGO, show_ata_dev_trim, NULL); | 
|  |  | 
|  | static DECLARE_TRANSPORT_CLASS(ata_dev_class, | 
|  | "ata_device", NULL, NULL, NULL); | 
|  |  | 
|  | static void ata_tdev_release(struct device *dev) | 
|  | { | 
|  | } | 
|  |  | 
|  | /** | 
|  | * ata_is_ata_dev  --  check if a struct device represents a ATA device | 
|  | * @dev:	device to check | 
|  | * | 
|  | * Returns: | 
|  | *	true if the device represents a ATA device, false otherwise | 
|  | */ | 
|  | static bool ata_is_ata_dev(const struct device *dev) | 
|  | { | 
|  | return dev->release == ata_tdev_release; | 
|  | } | 
|  |  | 
|  | static int ata_tdev_match(struct attribute_container *cont, | 
|  | struct device *dev) | 
|  | { | 
|  | struct ata_internal *i = to_ata_internal(ata_scsi_transport_template); | 
|  |  | 
|  | if (!ata_is_ata_dev(dev)) | 
|  | return 0; | 
|  | return &i->dev_attr_cont.ac == cont; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * ata_tdev_free  --  free an ATA transport device | 
|  | * @dev:	struct ata_device owning the transport device to free | 
|  | * | 
|  | * Free the ATA transport device for the specified ATA device. | 
|  | * | 
|  | * Note: | 
|  | *   This function must only be called for a ATA transport device that has not | 
|  | *   yet successfully been added using ata_tdev_add(). | 
|  | */ | 
|  | static void ata_tdev_free(struct ata_device *dev) | 
|  | { | 
|  | transport_destroy_device(&dev->tdev); | 
|  | put_device(&dev->tdev); | 
|  | } | 
|  |  | 
|  | /** | 
|  | * ata_tdev_delete  --  remove an ATA transport device | 
|  | * @ata_dev:	struct ata_device owning the transport device to delete | 
|  | * | 
|  | * Removes the ATA transport device for the specified ATA device. | 
|  | */ | 
|  | static void ata_tdev_delete(struct ata_device *ata_dev) | 
|  | { | 
|  | struct device *dev = &ata_dev->tdev; | 
|  |  | 
|  | transport_remove_device(dev); | 
|  | device_del(dev); | 
|  | ata_tdev_free(ata_dev); | 
|  | } | 
|  |  | 
|  | /** | 
|  | * ata_tdev_add  --  initialize an ATA transport device | 
|  | * @ata_dev:	struct ata_device owning the transport device to add | 
|  | * | 
|  | * Initialize an ATA transport device for sysfs.  It will be added in the | 
|  | * device tree below the ATA link device it belongs to. | 
|  | * | 
|  | * Returns %0 on success and a negative error code on error. | 
|  | */ | 
|  | static int ata_tdev_add(struct ata_device *ata_dev) | 
|  | { | 
|  | struct device *dev = &ata_dev->tdev; | 
|  | struct ata_link *link = ata_dev->link; | 
|  | struct ata_port *ap = link->ap; | 
|  | int error; | 
|  |  | 
|  | device_initialize(dev); | 
|  | dev->parent = &link->tdev; | 
|  | dev->release = ata_tdev_release; | 
|  | if (ata_is_host_link(link)) | 
|  | dev_set_name(dev, "dev%d.%d", ap->print_id,ata_dev->devno); | 
|  | else | 
|  | dev_set_name(dev, "dev%d.%d.0", ap->print_id, link->pmp); | 
|  |  | 
|  | transport_setup_device(dev); | 
|  | ata_acpi_bind_dev(ata_dev); | 
|  | error = device_add(dev); | 
|  | if (error) { | 
|  | ata_tdev_free(ata_dev); | 
|  | return error; | 
|  | } | 
|  |  | 
|  | error = transport_add_device(dev); | 
|  | if (error) { | 
|  | device_del(dev); | 
|  | ata_tdev_free(ata_dev); | 
|  | return error; | 
|  | } | 
|  |  | 
|  | transport_configure_device(dev); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * ATA link attributes | 
|  | */ | 
|  | static int noop(int x) | 
|  | { | 
|  | return x; | 
|  | } | 
|  |  | 
|  | #define ata_link_show_linkspeed(field, format)			\ | 
|  | static ssize_t							\ | 
|  | show_ata_link_##field(struct device *dev,			\ | 
|  | struct device_attribute *attr, char *buf)	\ | 
|  | {								\ | 
|  | struct ata_link *link = transport_class_to_link(dev);	\ | 
|  | \ | 
|  | return sprintf(buf, "%s\n",				\ | 
|  | sata_spd_string(format(link->field)));	\ | 
|  | } | 
|  |  | 
|  | #define ata_link_linkspeed_attr(field, format)			\ | 
|  | ata_link_show_linkspeed(field, format)			\ | 
|  | static DEVICE_ATTR(field, 0444, show_ata_link_##field, NULL) | 
|  |  | 
|  | ata_link_linkspeed_attr(hw_sata_spd_limit, fls); | 
|  | ata_link_linkspeed_attr(sata_spd_limit, fls); | 
|  | ata_link_linkspeed_attr(sata_spd, noop); | 
|  |  | 
|  | static DECLARE_TRANSPORT_CLASS(ata_link_class, | 
|  | "ata_link", NULL, NULL, NULL); | 
|  |  | 
|  | static void ata_tlink_release(struct device *dev) | 
|  | { | 
|  | } | 
|  |  | 
|  | /** | 
|  | * ata_is_link --  check if a struct device represents a ATA link | 
|  | * @dev:	device to check | 
|  | * | 
|  | * Returns: | 
|  | *	true if the device represents a ATA link, false otherwise | 
|  | */ | 
|  | static bool ata_is_link(const struct device *dev) | 
|  | { | 
|  | return dev->release == ata_tlink_release; | 
|  | } | 
|  |  | 
|  | static int ata_tlink_match(struct attribute_container *cont, | 
|  | struct device *dev) | 
|  | { | 
|  | struct ata_internal *i = to_ata_internal(ata_scsi_transport_template); | 
|  |  | 
|  | if (!ata_is_link(dev)) | 
|  | return 0; | 
|  | return &i->link_attr_cont.ac == cont; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * ata_tlink_delete  --  remove an ATA link transport device | 
|  | * @link:	struct ata_link owning the link transport device to remove | 
|  | * | 
|  | * Removes the link transport device of the specified ATA link. This also | 
|  | * removes the ATA device(s) associated with the link as well. | 
|  | */ | 
|  | void ata_tlink_delete(struct ata_link *link) | 
|  | { | 
|  | struct device *dev = &link->tdev; | 
|  | struct ata_device *ata_dev; | 
|  |  | 
|  | ata_for_each_dev(ata_dev, link, ALL) { | 
|  | ata_tdev_delete(ata_dev); | 
|  | } | 
|  |  | 
|  | transport_remove_device(dev); | 
|  | device_del(dev); | 
|  | transport_destroy_device(dev); | 
|  | put_device(dev); | 
|  | } | 
|  |  | 
|  | /** | 
|  | * ata_tlink_add  --  initialize an ATA link transport device | 
|  | * @link:	struct ata_link owning the link transport device to initialize | 
|  | * | 
|  | * Initialize an ATA link transport device for sysfs. It will be added in the | 
|  | * device tree below the ATA port it belongs to. | 
|  | * | 
|  | * Returns %0 on success and a negative error code on error. | 
|  | */ | 
|  | int ata_tlink_add(struct ata_link *link) | 
|  | { | 
|  | struct device *dev = &link->tdev; | 
|  | struct ata_port *ap = link->ap; | 
|  | struct ata_device *ata_dev; | 
|  | int error; | 
|  |  | 
|  | device_initialize(dev); | 
|  | dev->parent = &ap->tdev; | 
|  | dev->release = ata_tlink_release; | 
|  | if (ata_is_host_link(link)) | 
|  | dev_set_name(dev, "link%d", ap->print_id); | 
|  | else | 
|  | dev_set_name(dev, "link%d.%d", ap->print_id, link->pmp); | 
|  |  | 
|  | transport_setup_device(dev); | 
|  |  | 
|  | error = device_add(dev); | 
|  | if (error) | 
|  | goto tlink_err; | 
|  |  | 
|  | error = transport_add_device(dev); | 
|  | if (error) | 
|  | goto tlink_transport_err; | 
|  | transport_configure_device(dev); | 
|  |  | 
|  | ata_for_each_dev(ata_dev, link, ALL) { | 
|  | error = ata_tdev_add(ata_dev); | 
|  | if (error) | 
|  | goto tlink_dev_err; | 
|  | } | 
|  | return 0; | 
|  | tlink_dev_err: | 
|  | while (--ata_dev >= link->device) | 
|  | ata_tdev_delete(ata_dev); | 
|  | transport_remove_device(dev); | 
|  | tlink_transport_err: | 
|  | device_del(dev); | 
|  | tlink_err: | 
|  | transport_destroy_device(dev); | 
|  | put_device(dev); | 
|  | return error; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Setup / Teardown code | 
|  | */ | 
|  |  | 
|  | #define SETUP_TEMPLATE(attrb, field, perm, test)			\ | 
|  | i->private_##attrb[count] = dev_attr_##field;			\ | 
|  | i->private_##attrb[count].attr.mode = perm;			\ | 
|  | i->attrb[count] = &i->private_##attrb[count];			\ | 
|  | if (test)							\ | 
|  | count++ | 
|  |  | 
|  | #define SETUP_LINK_ATTRIBUTE(field)					\ | 
|  | SETUP_TEMPLATE(link_attrs, field, S_IRUGO, 1) | 
|  |  | 
|  | #define SETUP_PORT_ATTRIBUTE(field)					\ | 
|  | SETUP_TEMPLATE(port_attrs, field, S_IRUGO, 1) | 
|  |  | 
|  | #define SETUP_DEV_ATTRIBUTE(field)					\ | 
|  | SETUP_TEMPLATE(dev_attrs, field, S_IRUGO, 1) | 
|  |  | 
|  | /** | 
|  | * ata_attach_transport  --  instantiate ATA transport template | 
|  | */ | 
|  | struct scsi_transport_template *ata_attach_transport(void) | 
|  | { | 
|  | struct ata_internal *i; | 
|  | int count; | 
|  |  | 
|  | i = kzalloc(sizeof(struct ata_internal), GFP_KERNEL); | 
|  | if (!i) | 
|  | return NULL; | 
|  |  | 
|  | i->t.eh_strategy_handler	= ata_scsi_error; | 
|  | i->t.user_scan			= ata_scsi_user_scan; | 
|  |  | 
|  | i->t.host_attrs.ac.attrs = &i->port_attrs[0]; | 
|  | i->t.host_attrs.ac.class = &ata_port_class.class; | 
|  | i->t.host_attrs.ac.match = ata_tport_match; | 
|  | transport_container_register(&i->t.host_attrs); | 
|  |  | 
|  | i->link_attr_cont.ac.class = &ata_link_class.class; | 
|  | i->link_attr_cont.ac.attrs = &i->link_attrs[0]; | 
|  | i->link_attr_cont.ac.match = ata_tlink_match; | 
|  | transport_container_register(&i->link_attr_cont); | 
|  |  | 
|  | i->dev_attr_cont.ac.class = &ata_dev_class.class; | 
|  | i->dev_attr_cont.ac.attrs = &i->dev_attrs[0]; | 
|  | i->dev_attr_cont.ac.match = ata_tdev_match; | 
|  | transport_container_register(&i->dev_attr_cont); | 
|  |  | 
|  | count = 0; | 
|  | SETUP_PORT_ATTRIBUTE(nr_pmp_links); | 
|  | SETUP_PORT_ATTRIBUTE(idle_irq); | 
|  | SETUP_PORT_ATTRIBUTE(port_no); | 
|  | BUG_ON(count > ATA_PORT_ATTRS); | 
|  | i->port_attrs[count] = NULL; | 
|  |  | 
|  | count = 0; | 
|  | SETUP_LINK_ATTRIBUTE(hw_sata_spd_limit); | 
|  | SETUP_LINK_ATTRIBUTE(sata_spd_limit); | 
|  | SETUP_LINK_ATTRIBUTE(sata_spd); | 
|  | BUG_ON(count > ATA_LINK_ATTRS); | 
|  | i->link_attrs[count] = NULL; | 
|  |  | 
|  | count = 0; | 
|  | SETUP_DEV_ATTRIBUTE(class); | 
|  | SETUP_DEV_ATTRIBUTE(pio_mode); | 
|  | SETUP_DEV_ATTRIBUTE(dma_mode); | 
|  | SETUP_DEV_ATTRIBUTE(xfer_mode); | 
|  | SETUP_DEV_ATTRIBUTE(spdn_cnt); | 
|  | SETUP_DEV_ATTRIBUTE(ering); | 
|  | SETUP_DEV_ATTRIBUTE(id); | 
|  | SETUP_DEV_ATTRIBUTE(gscr); | 
|  | SETUP_DEV_ATTRIBUTE(trim); | 
|  | BUG_ON(count > ATA_DEV_ATTRS); | 
|  | i->dev_attrs[count] = NULL; | 
|  |  | 
|  | return &i->t; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * ata_release_transport  --  release ATA transport template instance | 
|  | * @t:		transport template instance | 
|  | */ | 
|  | void ata_release_transport(struct scsi_transport_template *t) | 
|  | { | 
|  | struct ata_internal *i = to_ata_internal(t); | 
|  |  | 
|  | transport_container_unregister(&i->t.host_attrs); | 
|  | transport_container_unregister(&i->link_attr_cont); | 
|  | transport_container_unregister(&i->dev_attr_cont); | 
|  |  | 
|  | kfree(i); | 
|  | } | 
|  |  | 
|  | __init int libata_transport_init(void) | 
|  | { | 
|  | int error; | 
|  |  | 
|  | error = transport_class_register(&ata_link_class); | 
|  | if (error) | 
|  | goto out_unregister_transport; | 
|  | error = transport_class_register(&ata_port_class); | 
|  | if (error) | 
|  | goto out_unregister_link; | 
|  | error = transport_class_register(&ata_dev_class); | 
|  | if (error) | 
|  | goto out_unregister_port; | 
|  | return 0; | 
|  |  | 
|  | out_unregister_port: | 
|  | transport_class_unregister(&ata_port_class); | 
|  | out_unregister_link: | 
|  | transport_class_unregister(&ata_link_class); | 
|  | out_unregister_transport: | 
|  | return error; | 
|  |  | 
|  | } | 
|  |  | 
|  | void __exit libata_transport_exit(void) | 
|  | { | 
|  | transport_class_unregister(&ata_link_class); | 
|  | transport_class_unregister(&ata_port_class); | 
|  | transport_class_unregister(&ata_dev_class); | 
|  | } |