NetBSD/sys/dev/ata/sata_subr.c

208 lines
5.8 KiB
C

/* $NetBSD: sata_subr.c,v 1.24 2018/06/21 21:52:15 jdolecek Exp $ */
/*-
* Copyright (c) 2004 The NetBSD Foundation, Inc.
* All rights reserved.
*
* This code is derived from software contributed to The NetBSD Foundation
* by Jason R. Thorpe of Wasabi Systems, Inc.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*/
/*
* Common functions for Serial ATA.
*/
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: sata_subr.c,v 1.24 2018/06/21 21:52:15 jdolecek Exp $");
#include <sys/param.h>
#include <sys/kernel.h>
#include <sys/proc.h>
#include <dev/ata/satareg.h>
#include <dev/ata/satavar.h>
#include <dev/ata/satapmpreg.h>
/*
* sata_speed:
*
* Return a string describing the port speed reported by
* the port's SStatus register.
*/
const char *
sata_speed(uint32_t sstatus)
{
static const char * const sata_speedtab[] = {
"no negotiated speed",
"1.5Gb/s",
"3.0Gb/s",
"6.0Gb/s",
"<unknown 4>",
"<unknown 5>",
"<unknown 6>",
"<unknown 7>",
"<unknown 8>",
"<unknown 9>",
"<unknown 10>",
"<unknown 11>",
"<unknown 12>",
"<unknown 13>",
"<unknown 14>",
"<unknown 15>",
};
return (sata_speedtab[(sstatus & SStatus_SPD_mask) >>
SStatus_SPD_shift]);
}
/*
* reset the PHY and bring it online
*/
uint32_t
sata_reset_interface(struct ata_channel *chp, bus_space_tag_t sata_t,
bus_space_handle_t scontrol_r, bus_space_handle_t sstatus_r, int flags)
{
uint32_t scontrol, sstatus;
int i;
ata_channel_lock_owned(chp);
/* bring the PHYs online.
* The work-around for errata #1 of the Intel GD31244 says that we must
* write 0 to the port first to be sure of correctly initializing
* the device. It doesn't hurt for other devices.
*/
bus_space_write_4(sata_t, scontrol_r, 0, 0);
scontrol = SControl_IPM_NONE | SControl_SPD_ANY | SControl_DET_INIT;
bus_space_write_4(sata_t, scontrol_r, 0, scontrol);
ata_delay(chp, 50, "sataup", flags);
scontrol &= ~SControl_DET_INIT;
bus_space_write_4(sata_t, scontrol_r, 0, scontrol);
ata_delay(chp, 50, "sataup", flags);
/* wait up to 1s for device to come up */
for (i = 0; i < 100; i++) {
sstatus = bus_space_read_4(sata_t, sstatus_r, 0);
if ((sstatus & SStatus_DET_mask) == SStatus_DET_DEV)
break;
ata_delay(chp, 10, "sataup", flags);
}
/*
* if we have a link up without device, wait a few more seconds
* for connection to establish
*/
if ((sstatus & SStatus_DET_mask) == SStatus_DET_DEV_NE) {
for (i = 0; i < 500; i++) {
ata_delay(chp, 10, "sataup", flags);
sstatus = bus_space_read_4(sata_t, sstatus_r, 0);
if ((sstatus & SStatus_DET_mask) == SStatus_DET_DEV)
break;
}
}
sata_interpret_det(chp, sstatus);
return (sstatus & SStatus_DET_mask);
}
void
sata_interpret_det(struct ata_channel *chp, uint32_t sstatus)
{
switch (sstatus & SStatus_DET_mask) {
case SStatus_DET_NODEV:
/* No Device; be silent. */
break;
case SStatus_DET_DEV_NE:
aprint_error("%s port %d: device connected, but "
"communication not established\n",
device_xname(chp->ch_atac->atac_dev), chp->ch_channel);
break;
case SStatus_DET_OFFLINE:
aprint_normal("%s port %d: PHY offline\n",
device_xname(chp->ch_atac->atac_dev), chp->ch_channel);
break;
case SStatus_DET_DEV:
aprint_normal("%s port %d: device present, speed: %s\n",
device_xname(chp->ch_atac->atac_dev), chp->ch_channel,
sata_speed(sstatus));
break;
default:
aprint_error("%s port %d: unknown SStatus: 0x%08x\n",
device_xname(chp->ch_atac->atac_dev), chp->ch_channel,
sstatus);
}
}
void
sata_interpret_sig(struct ata_channel *chp, int port, uint32_t sig)
{
int err;
ata_channel_lock_owned(chp);
/* some ATAPI devices have bogus lower two bytes, sigh */
if ((sig & 0xffff0000) == 0xeb140000) {
sig &= 0xffff0000;
sig |= 0x00000101;
}
if (chp->ch_drive == NULL) {
if (sig == 0x96690101)
err = atabus_alloc_drives(chp, PMP_MAX_DRIVES);
else
err = atabus_alloc_drives(chp, 1);
if (err)
return;
}
KASSERT(port < chp->ch_ndrives);
switch(sig) {
case 0x96690101:
KASSERT(port == 0 || port == PMP_PORT_CTL);
chp->ch_drive[PMP_PORT_CTL].drive_type = ATA_DRIVET_PM;
break;
case 0xc33c0101:
aprint_verbose_dev(chp->atabus, "port %d is SEMB, ignored\n",
port);
break;
case 0xeb140101:
chp->ch_drive[port].drive_type = ATA_DRIVET_ATAPI;
break;
case 0x00000101:
chp->ch_drive[port].drive_type = ATA_DRIVET_ATA;
break;
case 0xffffffff:
/* COMRESET time out */
break;
default:
chp->ch_drive[port].drive_type = ATA_DRIVET_ATA;
aprint_verbose_dev(chp->atabus,
"Unrecognized signature 0x%08x on port %d. "
"Assuming it's a disk.\n", sig, port);
break;
}
}