#include <sys/dada/dada.h>
#include <sys/dkbad.h>
#include <sys/dklabel.h>
#include <sys/dkio.h>
#include <sys/cdio.h>
#include <sys/vtoc.h>
#include <sys/dada/targets/daddef.h>
#include <sys/dada/targets/dadpriv.h>
#include <sys/file.h>
#include <sys/stat.h>
#include <sys/kstat.h>
#include <sys/vtrace.h>
#include <sys/aio_req.h>
#include <sys/note.h>
#include <sys/cmlb.h>
int dcd_error_level = DCD_ERR_RETRYABLE;
static int dcd_io_time = DCD_IO_TIME;
static int dcd_retry_count = DCD_RETRY_COUNT;
#ifndef lint
static int dcd_report_pfa = 1;
#endif
static int dcd_rot_delay = 4;
static int dcd_poll_busycnt = DCD_POLL_TIMEOUT;
static int dcdopen(dev_t *dev_p, int flag, int otyp, cred_t *cred_p);
static int dcdclose(dev_t dev, int flag, int otyp, cred_t *cred_p);
static int dcdstrategy(struct buf *bp);
static int dcddump(dev_t dev, caddr_t addr, daddr_t blkno, int nblk);
static int dcdioctl(dev_t, int, intptr_t, int, cred_t *, int *);
static int dcdread(dev_t dev, struct uio *uio, cred_t *cred_p);
static int dcdwrite(dev_t dev, struct uio *uio, cred_t *cred_p);
static int dcd_prop_op(dev_t, dev_info_t *, ddi_prop_op_t, int,
char *, caddr_t, int *);
static int dcdaread(dev_t dev, struct aio_req *aio, cred_t *cred_p);
static int dcdawrite(dev_t dev, struct aio_req *aio, cred_t *cred_p);
static void dcd_free_softstate(struct dcd_disk *un, dev_info_t *devi);
static int dcd_doattach(dev_info_t *devi, int (*f)());
static int dcd_validate_geometry(struct dcd_disk *un);
static ddi_devid_t dcd_get_devid(struct dcd_disk *un);
static ddi_devid_t dcd_create_devid(struct dcd_disk *un);
static int dcd_make_devid_from_serial(struct dcd_disk *un);
static void dcd_validate_model_serial(char *str, int *retlen, int totallen);
static int dcd_read_deviceid(struct dcd_disk *un);
static int dcd_write_deviceid(struct dcd_disk *un);
static int dcd_poll(struct dcd_pkt *pkt);
static char *dcd_rname(int reason);
static void dcd_flush_cache(struct dcd_disk *un);
static int dcd_compute_dk_capacity(struct dcd_device *devp,
diskaddr_t *capacity);
static int dcd_send_lb_rw_cmd(dev_info_t *devinfo, void *bufaddr,
diskaddr_t start_block, size_t reqlength, uchar_t cmd);
static void dcdmin(struct buf *bp);
static int dcdioctl_cmd(dev_t, struct udcd_cmd *,
enum uio_seg, enum uio_seg);
static void dcdstart(struct dcd_disk *un);
static void dcddone_and_mutex_exit(struct dcd_disk *un, struct buf *bp);
static void make_dcd_cmd(struct dcd_disk *un, struct buf *bp, int (*f)());
static void dcdudcdmin(struct buf *bp);
static int dcdrunout(caddr_t);
static int dcd_check_wp(dev_t dev);
static int dcd_unit_ready(dev_t dev);
static void dcd_handle_tran_busy(struct buf *bp, struct diskhd *dp,
struct dcd_disk *un);
static void dcdintr(struct dcd_pkt *pkt);
static int dcd_handle_incomplete(struct dcd_disk *un, struct buf *bp);
static void dcd_offline(struct dcd_disk *un, int bechatty);
static int dcd_ready_and_valid(dev_t dev, struct dcd_disk *un);
static void dcd_reset_disk(struct dcd_disk *un, struct dcd_pkt *pkt);
static void dcd_translate(struct dadkio_status32 *statp, struct udcd_cmd *cmdp);
static int dcdflushdone(struct buf *bp);
static int dcd_lb_rdwr(dev_info_t *devi, uchar_t cmd, void *bufaddr,
diskaddr_t start_block, size_t reqlength, void *tg_cookie);
static int dcd_lb_getphygeom(dev_info_t *devi, cmlb_geom_t *phygeomp);
static int dcd_lb_getinfo(dev_info_t *devi, int cmd, void *arg,
void *tg_cookie);
static cmlb_tg_ops_t dcd_lb_ops = {
TG_DK_OPS_VERSION_1,
dcd_lb_rdwr,
dcd_lb_getinfo
};
#ifndef lint
static void clean_print(dev_info_t *dev, char *label, uint_t level,
char *title, char *data, int len);
static void dcdrestart(void *arg);
#endif
static int dcd_check_error(struct dcd_disk *un, struct buf *bp);
static int dcd_create_errstats(struct dcd_disk *, int);
extern void dcd_log(dev_info_t *, char *, uint_t, const char *, ...)
__KPRINTFLIKE(4);
extern void makecommand(struct dcd_pkt *, int, uchar_t, uint32_t,
uchar_t, uint32_t, uchar_t, uchar_t);
static int dcdinfo(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg,
void **result);
static int dcdprobe(dev_info_t *devi);
static int dcdattach(dev_info_t *devi, ddi_attach_cmd_t cmd);
static int dcddetach(dev_info_t *devi, ddi_detach_cmd_t cmd);
static int dcdreset(dev_info_t *dip, ddi_reset_cmd_t cmd);
static int dcd_dr_detach(dev_info_t *devi);
static int dcdpower(dev_info_t *devi, int component, int level);
static void *dcd_state;
static int dcd_max_instance;
static char *dcd_label = "dad";
static char *diskokay = "disk okay\n";
#if DEBUG || lint
#define DCDDEBUG
#endif
int dcd_test_flag = 0;
#ifdef DCDDEBUG
static int dcddebug = 0;
#define DEBUGGING (dcddebug > 1)
#define DAD_DEBUG if (dcddebug == 1) dcd_log
#define DAD_DEBUG2 if (dcddebug > 1) dcd_log
#else
#define dcddebug (0)
#define DEBUGGING (0)
#define DAD_DEBUG if (0) dcd_log
#define DAD_DEBUG2 if (0) dcd_log
#endif
struct dcd_pkt_private {
struct buf *dcdpp_bp;
short dcdpp_retry_count;
short dcdpp_victim_retry_count;
};
_NOTE(SCHEME_PROTECTS_DATA("Unique per pkt", dcd_pkt_private buf))
#define PP_LEN (sizeof (struct dcd_pkt_private))
#define PKT_SET_BP(pkt, bp) \
((struct dcd_pkt_private *)pkt->pkt_private)->dcdpp_bp = bp
#define PKT_GET_BP(pkt) \
(((struct dcd_pkt_private *)pkt->pkt_private)->dcdpp_bp)
#define PKT_SET_RETRY_CNT(pkt, n) \
((struct dcd_pkt_private *)pkt->pkt_private)->dcdpp_retry_count = n
#define PKT_GET_RETRY_CNT(pkt) \
(((struct dcd_pkt_private *)pkt->pkt_private)->dcdpp_retry_count)
#define PKT_INCR_RETRY_CNT(pkt, n) \
((struct dcd_pkt_private *)pkt->pkt_private)->dcdpp_retry_count += n
#define PKT_SET_VICTIM_RETRY_CNT(pkt, n) \
((struct dcd_pkt_private *)pkt->pkt_private)->dcdpp_victim_retry_count \
= n
#define PKT_GET_VICTIM_RETRY_CNT(pkt) \
(((struct dcd_pkt_private *)pkt->pkt_private)->dcdpp_victim_retry_count)
#define PKT_INCR_VICTIM_RETRY_CNT(pkt, n) \
((struct dcd_pkt_private *)pkt->pkt_private)->dcdpp_victim_retry_count \
+= n
#define DISK_NOT_READY_RETRY_COUNT (dcd_retry_count / 2)
#define SET_BP_ERROR(bp, err) \
bioerror(bp, err);
#define IOSP KSTAT_IO_PTR(un->un_stats)
#define IO_PARTITION_STATS un->un_pstats[DCDPART(bp->b_edev)]
#define IOSP_PARTITION KSTAT_IO_PTR(IO_PARTITION_STATS)
#define DCD_DO_KSTATS(un, kstat_function, bp) \
ASSERT(mutex_owned(DCD_MUTEX)); \
if (bp != un->un_sbufp) { \
if (un->un_stats) { \
kstat_function(IOSP); \
} \
if (IO_PARTITION_STATS) { \
kstat_function(IOSP_PARTITION); \
} \
}
#define DCD_DO_ERRSTATS(un, x) \
if (un->un_errstats) { \
struct dcd_errstats *dtp; \
dtp = (struct dcd_errstats *)un->un_errstats->ks_data; \
dtp->x.value.ui32++; \
}
#define GET_SOFT_STATE(dev) \
struct dcd_disk *un; \
int instance, part; \
minor_t minor = getminor(dev); \
\
part = minor & DCDPART_MASK; \
instance = minor >> DCDUNIT_SHIFT; \
if ((un = ddi_get_soft_state(dcd_state, instance)) == NULL) \
return (ENXIO);
#define LOGICAL_BLOCK_ALIGN(blkno, blknoshift) \
(((blkno) & ((1 << (blknoshift)) - 1)) == 0)
#define NUM_SECTORS_32G 0x3EFFC10
static struct cb_ops dcd_cb_ops = {
dcdopen,
dcdclose,
dcdstrategy,
nodev,
dcddump,
dcdread,
dcdwrite,
dcdioctl,
nodev,
nodev,
nodev,
nochpoll,
dcd_prop_op,
0,
D_64BIT | D_MP | D_NEW,
CB_REV,
dcdaread,
dcdawrite
};
static struct dev_ops dcd_ops = {
DEVO_REV,
0,
dcdinfo,
nulldev,
dcdprobe,
dcdattach,
dcddetach,
dcdreset,
&dcd_cb_ops,
(struct bus_ops *)0,
dcdpower,
ddi_quiesce_not_supported,
};
#include <sys/modctl.h>
static struct modldrv modldrv = {
&mod_driverops,
"DAD Disk Driver",
&dcd_ops,
};
static struct modlinkage modlinkage = {
MODREV_1, &modldrv, NULL
};
static kmutex_t dcd_attach_mutex;
int
_init(void)
{
int e;
if ((e = ddi_soft_state_init(&dcd_state, sizeof (struct dcd_disk),
DCD_MAXUNIT)) != 0)
return (e);
mutex_init(&dcd_attach_mutex, NULL, MUTEX_DRIVER, NULL);
e = mod_install(&modlinkage);
if (e != 0) {
mutex_destroy(&dcd_attach_mutex);
ddi_soft_state_fini(&dcd_state);
return (e);
}
return (e);
}
int
_fini(void)
{
int e;
if ((e = mod_remove(&modlinkage)) != 0)
return (e);
ddi_soft_state_fini(&dcd_state);
mutex_destroy(&dcd_attach_mutex);
return (e);
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&modlinkage, modinfop));
}
static int
dcdprobe(dev_info_t *devi)
{
struct dcd_device *devp;
int rval = DDI_PROBE_PARTIAL;
int instance;
devp = ddi_get_driver_private(devi);
instance = ddi_get_instance(devi);
mutex_enter(&dcd_attach_mutex);
if (instance > dcd_max_instance)
dcd_max_instance = instance;
mutex_exit(&dcd_attach_mutex);
DAD_DEBUG2(devp->dcd_dev, dcd_label, DCD_DEBUG, "dcdprobe:\n");
if (ddi_get_soft_state(dcd_state, instance) != NULL)
return (DDI_PROBE_PARTIAL);
DAD_DEBUG2(devp->dcd_dev, dcd_label, DCD_DEBUG,
"dcdprobe: %x\n", dcd_probe(devp, NULL_FUNC));
switch (dcd_probe(devp, NULL_FUNC)) {
default:
case DCDPROBE_NORESP:
case DCDPROBE_NONCCS:
case DCDPROBE_NOMEM:
case DCDPROBE_FAILURE:
case DCDPROBE_BUSY:
break;
case DCDPROBE_EXISTS:
DAD_DEBUG2(devp->dcd_dev, dcd_label, DCD_DEBUG,
"config %x\n", devp->dcd_ident->dcd_config);
if ((devp->dcd_ident->dcd_config & ATAPI_DEVICE) == 0) {
if (devp->dcd_ident->dcd_config & ATANON_REMOVABLE) {
rval = DDI_PROBE_SUCCESS;
} else
rval = DDI_PROBE_FAILURE;
} else {
rval = DDI_PROBE_FAILURE;
}
break;
}
dcd_unprobe(devp);
DAD_DEBUG2(devp->dcd_dev, dcd_label, DCD_DEBUG,
"dcdprobe returns %x\n", rval);
return (rval);
}
static int
dcdattach(dev_info_t *devi, ddi_attach_cmd_t cmd)
{
int instance, rval;
struct dcd_device *devp;
struct dcd_disk *un;
struct diskhd *dp;
char *pm_comp[] =
{ "NAME=ide-disk", "0=standby", "1=idle", "2=active" };
ASSERT(NO_COMPETING_THREADS);
devp = ddi_get_driver_private(devi);
instance = ddi_get_instance(devi);
DAD_DEBUG2(devp->dcd_dev, dcd_label, DCD_DEBUG, "Attach Started\n");
switch (cmd) {
case DDI_ATTACH:
break;
case DDI_RESUME:
if (!(un = ddi_get_soft_state(dcd_state, instance)))
return (DDI_FAILURE);
mutex_enter(DCD_MUTEX);
Restore_state(un);
un->un_last_state = un->un_save_state;
un->un_throttle = 2;
cv_broadcast(&un->un_suspend_cv);
mutex_exit(DCD_MUTEX);
(void) pm_raise_power(DCD_DEVINFO, 0, DCD_DEVICE_ACTIVE);
mutex_enter(DCD_MUTEX);
dp = &un->un_utab;
if (dp->b_actf && (dp->b_forw == NULL)) {
dcdstart(un);
}
mutex_exit(DCD_MUTEX);
return (DDI_SUCCESS);
default:
return (DDI_FAILURE);
}
if (dcd_doattach(devi, SLEEP_FUNC) == DDI_FAILURE) {
return (DDI_FAILURE);
}
if (!(un = (struct dcd_disk *)
ddi_get_soft_state(dcd_state, instance))) {
return (DDI_FAILURE);
}
devp->dcd_private = (ataopaque_t)un;
(void) ddi_prop_create(DDI_DEV_T_NONE, devi, DDI_PROP_CANSLEEP,
DDI_KERNEL_IOCTL, NULL, 0);
(void) ddi_prop_update_string(DDI_DEV_T_NONE, devi,
"pm-hardware-state", (caddr_t)"needs-suspend-resume");
rval = ddi_prop_update_string_array(DDI_DEV_T_NONE,
devi, "pm-components", pm_comp, 4);
if (rval == DDI_PROP_SUCCESS) {
(void) pm_raise_power(DCD_DEVINFO, 0, DCD_DEVICE_ACTIVE);
}
ddi_report_dev(devi);
cmlb_alloc_handle(&un->un_dklbhandle);
if (cmlb_attach(devi,
&dcd_lb_ops,
0,
B_FALSE,
B_FALSE,
DDI_NT_BLOCK_CHAN,
CMLB_FAKE_GEOM_LABEL_IOCTLS_VTOC8,
un->un_dklbhandle,
0) != 0) {
cmlb_free_handle(&un->un_dklbhandle);
dcd_free_softstate(un, devi);
return (DDI_FAILURE);
}
mutex_enter(DCD_MUTEX);
(void) dcd_validate_geometry(un);
if (dcd_get_devid(un) == NULL) {
(void) dcd_create_devid(un);
}
mutex_exit(DCD_MUTEX);
return (DDI_SUCCESS);
}
static void
dcd_free_softstate(struct dcd_disk *un, dev_info_t *devi)
{
struct dcd_device *devp;
int instance = ddi_get_instance(devi);
devp = ddi_get_driver_private(devi);
if (un) {
sema_destroy(&un->un_semoclose);
cv_destroy(&un->un_sbuf_cv);
cv_destroy(&un->un_state_cv);
cv_destroy(&un->un_disk_busy_cv);
cv_destroy(&un->un_suspend_cv);
if (un->un_sbufp)
freerbuf(un->un_sbufp);
if (un->un_dp) {
kmem_free((caddr_t)un->un_dp, sizeof (*un->un_dp));
}
ddi_devid_unregister(DCD_DEVINFO);
if (un->un_devid) {
ddi_devid_free(un->un_devid);
un->un_devid = NULL;
}
if (un->un_stats) {
kstat_delete(un->un_stats);
}
}
ddi_soft_state_free(dcd_state, instance);
devp->dcd_private = (ataopaque_t)0;
dcd_unprobe(devp);
ddi_prop_remove_all(devi);
}
static int
dcddetach(dev_info_t *devi, ddi_detach_cmd_t cmd)
{
int instance;
struct dcd_disk *un;
clock_t wait_cmds_complete;
instance = ddi_get_instance(devi);
if (!(un = ddi_get_soft_state(dcd_state, instance)))
return (DDI_FAILURE);
switch (cmd) {
case DDI_DETACH:
return (dcd_dr_detach(devi));
case DDI_SUSPEND:
mutex_enter(DCD_MUTEX);
if (un->un_state == DCD_STATE_SUSPENDED) {
mutex_exit(DCD_MUTEX);
return (DDI_SUCCESS);
}
un->un_throttle = 0;
un->un_save_state = un->un_last_state;
New_state(un, DCD_STATE_SUSPENDED);
wait_cmds_complete = ddi_get_lbolt();
wait_cmds_complete +=
DCD_WAIT_CMDS_COMPLETE * drv_usectohz(1000000);
while (un->un_ncmds) {
if (cv_timedwait(&un->un_disk_busy_cv,
DCD_MUTEX, wait_cmds_complete) == -1) {
DAD_DEBUG2(DCD_DEVINFO, dcd_label,
DCD_DEBUG, "dcddetach: SUSPEND "
"failed due to outstanding cmds\n");
Restore_state(un);
mutex_exit(DCD_MUTEX);
return (DDI_FAILURE);
}
}
mutex_exit(DCD_MUTEX);
return (DDI_SUCCESS);
}
return (DDI_FAILURE);
}
static int
dcdreset(dev_info_t *dip, ddi_reset_cmd_t cmd)
{
struct dcd_disk *un;
int instance;
instance = ddi_get_instance(dip);
if (!(un = ddi_get_soft_state(dcd_state, instance)))
return (DDI_FAILURE);
dcd_flush_cache(un);
return (DDI_SUCCESS);
}
static int
dcd_dr_detach(dev_info_t *devi)
{
struct dcd_device *devp;
struct dcd_disk *un;
if ((devp = ddi_get_driver_private(devi)) == NULL)
return (DDI_FAILURE);
un = (struct dcd_disk *)devp->dcd_private;
#ifndef lint
_NOTE(COMPETING_THREADS_NOW);
#endif
mutex_enter(DCD_MUTEX);
if (un->un_ncmds) {
mutex_exit(DCD_MUTEX);
_NOTE(NO_COMPETING_THREADS_NOW);
return (DDI_FAILURE);
}
mutex_exit(DCD_MUTEX);
cmlb_detach(un->un_dklbhandle, 0);
cmlb_free_handle(&un->un_dklbhandle);
(void) pm_lower_power(DCD_DEVINFO, 0, DCD_DEVICE_STANDBY);
_NOTE(NO_COMPETING_THREADS_NOW);
dcd_free_softstate(un, devi);
return (DDI_SUCCESS);
}
static int
dcdpower(dev_info_t *devi, int component, int level)
{
struct dcd_pkt *pkt;
struct dcd_disk *un;
int instance;
uchar_t cmd;
instance = ddi_get_instance(devi);
if (!(un = ddi_get_soft_state(dcd_state, instance)) ||
(DCD_DEVICE_STANDBY > level) || (level > DCD_DEVICE_ACTIVE) ||
component != 0) {
return (DDI_FAILURE);
}
mutex_enter(DCD_MUTEX);
if ((un->un_ncmds) && (level != DCD_DEVICE_ACTIVE)) {
mutex_exit(DCD_MUTEX);
return (DDI_FAILURE);
}
if ((un->un_state == DCD_STATE_OFFLINE) ||
(un->un_state == DCD_STATE_FATAL)) {
mutex_exit(DCD_MUTEX);
return (DDI_FAILURE);
}
if (level == DCD_DEVICE_ACTIVE) {
un->un_power_level = DCD_DEVICE_ACTIVE;
if (un->un_state == DCD_STATE_PM_SUSPENDED)
Restore_state(un);
mutex_exit(DCD_MUTEX);
} else {
pkt = dcd_init_pkt(ROUTE, (struct dcd_pkt *)NULL,
NULL, (uint32_t)sizeof (struct dcd_cmd), 2, PP_LEN,
PKT_CONSISTENT, NULL_FUNC, NULL);
if (pkt == (struct dcd_pkt *)NULL) {
mutex_exit(DCD_MUTEX);
return (DDI_FAILURE);
}
switch (level) {
case DCD_DEVICE_IDLE:
cmd = ATA_IDLE_IMMEDIATE;
break;
case DCD_DEVICE_STANDBY:
cmd = ATA_STANDBY_IMMEDIATE;
break;
}
makecommand(pkt, 0, cmd, 0, 0, 0, NO_DATA_XFER, 0);
mutex_exit(DCD_MUTEX);
if ((dcd_poll(pkt)) || (SCBP_C(pkt) != STATUS_GOOD)) {
dcd_destroy_pkt(pkt);
return (DDI_FAILURE);
}
dcd_destroy_pkt(pkt);
mutex_enter(DCD_MUTEX);
if (un->un_state != DCD_STATE_PM_SUSPENDED)
New_state(un, DCD_STATE_PM_SUSPENDED);
un->un_power_level = level;
mutex_exit(DCD_MUTEX);
}
return (DDI_SUCCESS);
}
static int
dcd_doattach(dev_info_t *devi, int (*canwait)())
{
struct dcd_device *devp;
struct dcd_disk *un = (struct dcd_disk *)0;
int instance;
int km_flags = (canwait != NULL_FUNC)? KM_SLEEP : KM_NOSLEEP;
int rval;
char *prop_template = "target%x-dcd-options";
int options;
char prop_str[32];
int target;
diskaddr_t capacity;
devp = ddi_get_driver_private(devi);
switch (dcd_probe(devp, canwait)) {
default:
return (DDI_FAILURE);
case DCDPROBE_EXISTS:
if ((devp->dcd_ident->dcd_config & ATAPI_DEVICE) == 0) {
if (devp->dcd_ident->dcd_config & ATANON_REMOVABLE) {
rval = DDI_SUCCESS;
} else {
rval = DDI_FAILURE;
goto error;
}
} else {
rval = DDI_FAILURE;
goto error;
}
}
instance = ddi_get_instance(devp->dcd_dev);
if (ddi_soft_state_zalloc(dcd_state, instance) != DDI_SUCCESS) {
rval = DDI_FAILURE;
goto error;
}
un = ddi_get_soft_state(dcd_state, instance);
un->un_sbufp = getrbuf(km_flags);
if (un->un_sbufp == (struct buf *)NULL) {
rval = DDI_FAILURE;
goto error;
}
un->un_dcd = devp;
un->un_power_level = -1;
un->un_tgattribute.media_is_writable = 1;
sema_init(&un->un_semoclose, 1, NULL, SEMA_DRIVER, NULL);
cv_init(&un->un_sbuf_cv, NULL, CV_DRIVER, NULL);
cv_init(&un->un_state_cv, NULL, CV_DRIVER, NULL);
cv_init(&un->un_disk_busy_cv, NULL, CV_DRIVER, NULL);
cv_init(&un->un_suspend_cv, NULL, CV_DRIVER, NULL);
if (un->un_dp == 0) {
un->un_dp = (struct dcd_drivetype *)
kmem_zalloc(sizeof (struct dcd_drivetype), km_flags);
if (!un->un_dp) {
rval = DDI_FAILURE;
goto error;
}
if ((devp->dcd_ident->dcd_config & ATAPI_DEVICE) == 0) {
if (devp->dcd_ident->dcd_config & ATANON_REMOVABLE) {
un->un_dp->ctype = CTYPE_DISK;
}
} else {
rval = DDI_FAILURE;
goto error;
}
un->un_dp->name = "CCS";
un->un_dp->options = 0;
}
un->un_secsize = DEV_BSIZE;
if (dcd_compute_dk_capacity(devp, &capacity) == 0) {
un->un_diskcapacity = capacity;
un->un_lbasize = DEV_BSIZE;
}
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG, "Geometry Data\n");
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG, "cyls %x, heads %x",
devp->dcd_ident->dcd_fixcyls,
devp->dcd_ident->dcd_heads);
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG, "sectors %x,",
devp->dcd_ident->dcd_sectors);
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG, "capacity %llx\n",
capacity);
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"dcdprobe: drive selected\n");
target = devp->dcd_address->da_target;
(void) sprintf(prop_str, prop_template, target);
options = ddi_prop_get_int(DDI_DEV_T_ANY, devi, DDI_PROP_NOTPROM,
prop_str, -1);
if (options < 0) {
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"No per target properties");
} else {
if ((options & DCD_DMA_MODE) == DCD_DMA_MODE) {
un->un_dp->options |= DMA_SUPPORTTED;
un->un_dp->dma_mode = (options >> 3) & 0x03;
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"mode %x\n", un->un_dp->dma_mode);
} else {
un->un_dp->options &= ~DMA_SUPPORTTED;
un->un_dp->pio_mode = options & 0x7;
if (options & DCD_BLOCK_MODE)
un->un_dp->options |= BLOCK_MODE;
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"mode %x\n", un->un_dp->pio_mode);
}
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"options %x,", un->un_dp->options);
}
un->un_throttle = 2;
un->un_max_xfer_size = MAX_ATA_XFER_SIZE;
mutex_enter(DCD_MUTEX);
un->un_write_cache_enabled = (devp->dcd_ident->dcd_majvers == 0xffff) ||
((devp->dcd_ident->dcd_majvers & IDENTIFY_80_ATAPI_4) == 0) ||
(devp->dcd_ident->dcd_features85 & IDENTIFY_85_WCE) != 0;
mutex_exit(DCD_MUTEX);
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"dcd_doattach returns good\n");
return (rval);
error:
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG, "dcd_doattach failed\n");
dcd_free_softstate(un, devi);
return (rval);
}
#ifdef NOTNEEDED
dcd_set_multiple(struct dcd_disk *un)
{
int status;
struct udcd_cmd ucmd;
struct dcd_cmd cdb;
dev_t dev;
(void) bzero((caddr_t)&ucmd, sizeof (ucmd));
(void) bzero((caddr_t)&cdb, sizeof (struct dcd_cmd));
cdb.cmd = ATA_SET_MULTIPLE;
cdb.size = un->un_lbasize * un->un_dp->block_factor;
cdb.sector_num.lba_num = 0;
cdb.address_mode = ADD_LBA_MODE;
cdb.direction = NO_DATA_XFER;
ucmd.udcd_flags = 0;
ucmd.udcd_cmd = &cdb;
ucmd.udcd_bufaddr = NULL;
ucmd.udcd_buflen = 0;
ucmd.udcd_flags |= UDCD_SILENT;
dev = makedevice(ddi_driver_major(DCD_DEVINFO),
ddi_get_instance(DCD_DEVINFO) << DCDUNIT_SHIFT);
status = dcdioctl_cmd(dev, &ucmd, UIO_SYSSPACE, UIO_SYSSPACE);
return (status);
}
dcd_set_features(struct dcd_disk *un, uchar_t mode)
{
int status;
struct udcd_cmd ucmd;
struct dcd_cmd cdb;
dev_t dev;
(void) bzero((caddr_t)&ucmd, sizeof (ucmd));
(void) bzero((caddr_t)&cdb, sizeof (struct dcd_cmd));
cdb.cmd = ATA_SET_FEATURES;
cdb.size = un->un_lbasize * mode;
cdb.sector_num.lba_num = 0;
cdb.address_mode = ADD_LBA_MODE;
cdb.direction = NO_DATA_XFER;
cdb.features = ATA_FEATURE_SET_MODE;
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"size %x, features %x, cmd %x\n",
cdb.size, cdb.features, cdb.cmd);
ucmd.udcd_flags = 0;
ucmd.udcd_cmd = &cdb;
ucmd.udcd_bufaddr = NULL;
ucmd.udcd_buflen = 0;
ucmd.udcd_flags |= UDCD_SILENT;
dev = makedevice(ddi_driver_major(DCD_DEVINFO),
ddi_get_instance(DCD_DEVINFO) << DCDUNIT_SHIFT);
status = dcdioctl_cmd(dev, &ucmd, UIO_SYSSPACE, UIO_SYSSPACE);
return (status);
}
#endif
static int
dcd_validate_geometry(struct dcd_disk *un)
{
int secsize = 0;
struct dcd_device *devp;
int secdiv;
int rval;
ASSERT(mutex_owned(DCD_MUTEX));
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"dcd_validate_geometry: started \n");
if (un->un_lbasize < 0) {
return (DCD_BAD_LABEL);
}
if (un->un_state == DCD_STATE_PM_SUSPENDED) {
mutex_exit(DCD_MUTEX);
if (pm_raise_power(DCD_DEVINFO, 0, DCD_DEVICE_ACTIVE) !=
DDI_SUCCESS) {
mutex_enter(DCD_MUTEX);
return (DCD_BAD_LABEL);
}
mutex_enter(DCD_MUTEX);
}
secsize = un->un_secsize;
for (secdiv = 0; secsize = secsize >> 1; secdiv++)
;
un->un_secdiv = secdiv;
devp = un->un_dcd;
if (((devp->dcd_ident->dcd_config & ATAPI_DEVICE) == 0) &&
(devp->dcd_ident->dcd_config & ATANON_REMOVABLE)) {
mutex_exit(DCD_MUTEX);
rval = cmlb_validate(un->un_dklbhandle, 0, 0);
mutex_enter(DCD_MUTEX);
if (rval == ENOMEM)
return (DCD_NO_MEM_FOR_LABEL);
else if (rval != 0)
return (DCD_BAD_LABEL);
} else {
return (DCD_BAD_LABEL);
}
secsize = un->un_lbasize;
for (secdiv = 0; secsize = secsize >> 1; secdiv++)
;
un->un_lbadiv = secdiv;
secsize = un->un_lbasize >> DEV_BSHIFT;
for (secdiv = 0; secsize = secsize >> 1; secdiv++)
;
un->un_blknoshift = secdiv;
return (0);
}
static int
dcdopen(dev_t *dev_p, int flag, int otyp, cred_t *cred_p)
{
dev_t dev = *dev_p;
int rval = EIO;
int partmask;
int nodelay = (flag & (FNDELAY | FNONBLOCK));
int i;
char kstatname[KSTAT_STRLEN];
diskaddr_t lblocks;
char *partname;
GET_SOFT_STATE(dev);
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"Inside Open flag %x, otyp %x\n", flag, otyp);
if (otyp >= OTYPCNT) {
return (EINVAL);
}
partmask = 1 << part;
sema_p(&un->un_semoclose);
mutex_enter(DCD_MUTEX);
if ((un->un_state & DCD_STATE_FATAL) == DCD_STATE_FATAL) {
rval = ENXIO;
goto done;
}
while (un->un_state == DCD_STATE_SUSPENDED) {
cv_wait(&un->un_suspend_cv, DCD_MUTEX);
}
if ((un->un_state == DCD_STATE_PM_SUSPENDED) && (!nodelay)) {
mutex_exit(DCD_MUTEX);
if (pm_raise_power(DCD_DEVINFO, 0, DCD_DEVICE_ACTIVE)
!= DDI_SUCCESS) {
mutex_enter(DCD_MUTEX);
rval = EIO;
goto done;
}
mutex_enter(DCD_MUTEX);
}
un->un_cmd_flags = 0;
un->un_cmd_stat_size = 2;
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG, "dcdopen un=0x%p\n",
(void *)un);
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"exclopen=%x, flag=%x, regopen=%x\n",
un->un_exclopen, flag, un->un_ocmap.regopen[otyp]);
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"Exclusive open flag %x, partmask %x\n",
un->un_exclopen, partmask);
if (un->un_exclopen & (partmask)) {
failed_exclusive:
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"exclusive open fails\n");
rval = EBUSY;
goto done;
}
if (flag & FEXCL) {
int i;
if (un->un_ocmap.lyropen[part]) {
goto failed_exclusive;
}
for (i = 0; i < (OTYPCNT - 1); i++) {
if (un->un_ocmap.regopen[i] & (partmask)) {
goto failed_exclusive;
}
}
}
if (flag & FWRITE) {
mutex_exit(DCD_MUTEX);
if (dcd_check_wp(dev)) {
sema_v(&un->un_semoclose);
return (EROFS);
}
mutex_enter(DCD_MUTEX);
}
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"Check Write Protect handled\n");
if (!nodelay) {
mutex_exit(DCD_MUTEX);
if ((rval = dcd_ready_and_valid(dev, un)) != 0) {
rval = EIO;
}
(void) pm_idle_component(DCD_DEVINFO, 0);
if (rval || cmlb_partinfo(un->un_dklbhandle,
part, &lblocks, NULL, &partname, NULL, 0) ||
lblocks <= 0) {
rval = EIO;
mutex_enter(DCD_MUTEX);
goto done;
}
mutex_enter(DCD_MUTEX);
}
if (otyp == OTYP_LYR) {
un->un_ocmap.lyropen[part]++;
} else {
un->un_ocmap.regopen[otyp] |= partmask;
}
if (flag & FEXCL) {
un->un_exclopen |= (partmask);
}
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"open of part %d type %d\n",
part, otyp);
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"Kstats getting updated\n");
_NOTE(NO_COMPETING_THREADS_NOW);
mutex_exit(DCD_MUTEX);
if (un->un_stats == (kstat_t *)0) {
un->un_stats = kstat_create("dad", instance,
NULL, "disk", KSTAT_TYPE_IO, 1,
KSTAT_FLAG_PERSISTENT);
if (un->un_stats) {
un->un_stats->ks_lock = DCD_MUTEX;
kstat_install(un->un_stats);
}
if (!nodelay) {
for (i = 0; i < NDKMAP; i++) {
if ((un->un_pstats[i] == (kstat_t *)0) &&
(cmlb_partinfo(un->un_dklbhandle,
i, &lblocks, NULL, &partname,
NULL, 0) == 0) && lblocks > 0) {
(void) sprintf(kstatname, "dad%d,%s",
instance, partname);
un->un_pstats[i] = kstat_create("dad",
instance,
kstatname,
"partition",
KSTAT_TYPE_IO,
1,
KSTAT_FLAG_PERSISTENT);
if (un->un_pstats[i]) {
un->un_pstats[i]->ks_lock =
DCD_MUTEX;
kstat_install(un->un_pstats[i]);
}
}
}
}
(void) dcd_create_errstats(un, instance);
}
#ifndef lint
_NOTE(COMPETING_THREADS_NOW);
#endif
sema_v(&un->un_semoclose);
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG, "Open success\n");
return (0);
done:
mutex_exit(DCD_MUTEX);
sema_v(&un->un_semoclose);
return (rval);
}
static int
dcd_ready_and_valid(dev_t dev, struct dcd_disk *un)
{
int rval = 1;
int g_error = 0;
mutex_enter(DCD_MUTEX);
if (un->un_ncmds == 0) {
(void) dcd_unit_ready(dev);
}
if (un->un_state == DCD_STATE_NORMAL) {
rval = dcd_unit_ready(dev);
if (rval != 0 && rval != EACCES) {
dcd_offline(un, 1);
goto done;
}
}
if (un->un_format_in_progress == 0) {
g_error = dcd_validate_geometry(un);
}
if (g_error == DCD_BAD_LABEL) {
rval = 1;
goto done;
}
un->un_mediastate = DKIO_INSERTED;
cv_broadcast(&un->un_state_cv);
rval = 0;
done:
mutex_exit(DCD_MUTEX);
return (rval);
}
static int
dcdclose(dev_t dev, int flag, int otyp, cred_t *cred_p)
{
uchar_t *cp;
int i;
GET_SOFT_STATE(dev);
if (otyp >= OTYPCNT)
return (ENXIO);
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"close of part %d type %d\n",
part, otyp);
sema_p(&un->un_semoclose);
mutex_enter(DCD_MUTEX);
if (un->un_exclopen & (1<<part)) {
un->un_exclopen &= ~(1<<part);
}
if (otyp == OTYP_LYR) {
un->un_ocmap.lyropen[part] -= 1;
} else {
un->un_ocmap.regopen[otyp] &= ~(1<<part);
}
cp = &un->un_ocmap.chkd[0];
while (cp < &un->un_ocmap.chkd[OCSIZE]) {
if (*cp != (uchar_t)0) {
break;
}
cp++;
}
if (cp == &un->un_ocmap.chkd[OCSIZE]) {
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG, "last close\n");
if (un->un_state == DCD_STATE_OFFLINE) {
dcd_offline(un, 1);
}
mutex_exit(DCD_MUTEX);
(void) cmlb_close(un->un_dklbhandle, 0);
_NOTE(NO_COMPETING_THREADS_NOW);
if (un->un_stats) {
kstat_delete(un->un_stats);
un->un_stats = 0;
}
for (i = 0; i < NDKMAP; i++) {
if (un->un_pstats[i]) {
kstat_delete(un->un_pstats[i]);
un->un_pstats[i] = (kstat_t *)0;
}
}
if (un->un_errstats) {
kstat_delete(un->un_errstats);
un->un_errstats = (kstat_t *)0;
}
mutex_enter(DCD_MUTEX);
#ifndef lint
_NOTE(COMPETING_THREADS_NOW);
#endif
}
mutex_exit(DCD_MUTEX);
sema_v(&un->un_semoclose);
return (0);
}
static void
dcd_offline(struct dcd_disk *un, int bechatty)
{
if (bechatty)
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN, "offline\n");
mutex_exit(DCD_MUTEX);
cmlb_invalidate(un->un_dklbhandle, 0);
mutex_enter(DCD_MUTEX);
}
static int
dcdinfo(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg, void **result)
{
dev_t dev;
struct dcd_disk *un;
int instance, error;
switch (infocmd) {
case DDI_INFO_DEVT2DEVINFO:
dev = (dev_t)arg;
instance = DCDUNIT(dev);
if ((un = ddi_get_soft_state(dcd_state, instance)) == NULL)
return (DDI_FAILURE);
*result = (void *) DCD_DEVINFO;
error = DDI_SUCCESS;
break;
case DDI_INFO_DEVT2INSTANCE:
dev = (dev_t)arg;
instance = DCDUNIT(dev);
*result = (void *)(uintptr_t)instance;
error = DDI_SUCCESS;
break;
default:
error = DDI_FAILURE;
}
return (error);
}
static int
dcd_prop_op(dev_t dev, dev_info_t *dip, ddi_prop_op_t prop_op, int mod_flags,
char *name, caddr_t valuep, int *lengthp)
{
struct dcd_disk *un;
if ((un = ddi_get_soft_state(dcd_state, ddi_get_instance(dip))) == NULL)
return (ddi_prop_op(dev, dip, prop_op, mod_flags,
name, valuep, lengthp));
return (cmlb_prop_op(un->un_dklbhandle,
dev, dip, prop_op, mod_flags, name, valuep, lengthp,
DCDPART(dev), NULL));
}
void
dcduscsimin(struct buf *bp)
{
}
static void
dcdmin(struct buf *bp)
{
struct dcd_disk *un;
int instance;
minor_t minor = getminor(bp->b_edev);
instance = minor >> DCDUNIT_SHIFT;
un = ddi_get_soft_state(dcd_state, instance);
if (bp->b_bcount > un->un_max_xfer_size)
bp->b_bcount = un->un_max_xfer_size;
}
static int
dcdread(dev_t dev, struct uio *uio, cred_t *cred_p)
{
int secmask;
GET_SOFT_STATE(dev);
#ifdef lint
part = part;
#endif
secmask = un->un_secsize - 1;
if (uio->uio_loffset & ((offset_t)(secmask))) {
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"file offset not modulo %d\n",
un->un_secsize);
return (EINVAL);
} else if (uio->uio_iov->iov_len & (secmask)) {
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"transfer length not modulo %d\n", un->un_secsize);
return (EINVAL);
}
return (physio(dcdstrategy, (struct buf *)0, dev, B_READ, dcdmin, uio));
}
static int
dcdaread(dev_t dev, struct aio_req *aio, cred_t *cred_p)
{
int secmask;
struct uio *uio = aio->aio_uio;
GET_SOFT_STATE(dev);
#ifdef lint
part = part;
#endif
secmask = un->un_secsize - 1;
if (uio->uio_loffset & ((offset_t)(secmask))) {
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"file offset not modulo %d\n",
un->un_secsize);
return (EINVAL);
} else if (uio->uio_iov->iov_len & (secmask)) {
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"transfer length not modulo %d\n", un->un_secsize);
return (EINVAL);
}
return (aphysio(dcdstrategy, anocancel, dev, B_READ, dcdmin, aio));
}
static int
dcdwrite(dev_t dev, struct uio *uio, cred_t *cred_p)
{
int secmask;
GET_SOFT_STATE(dev);
#ifdef lint
part = part;
#endif
secmask = un->un_secsize - 1;
if (uio->uio_loffset & ((offset_t)(secmask))) {
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"file offset not modulo %d\n",
un->un_secsize);
return (EINVAL);
} else if (uio->uio_iov->iov_len & (secmask)) {
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"transfer length not modulo %d\n", un->un_secsize);
return (EINVAL);
}
return (physio(dcdstrategy, (struct buf *)0, dev, B_WRITE, dcdmin,
uio));
}
static int
dcdawrite(dev_t dev, struct aio_req *aio, cred_t *cred_p)
{
int secmask;
struct uio *uio = aio->aio_uio;
GET_SOFT_STATE(dev);
#ifdef lint
part = part;
#endif
secmask = un->un_secsize - 1;
if (uio->uio_loffset & ((offset_t)(secmask))) {
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"file offset not modulo %d\n",
un->un_secsize);
return (EINVAL);
} else if (uio->uio_iov->iov_len & (secmask)) {
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"transfer length not modulo %d\n", un->un_secsize);
return (EINVAL);
}
return (aphysio(dcdstrategy, anocancel, dev, B_WRITE, dcdmin, aio));
}
static int
dcdstrategy(struct buf *bp)
{
struct dcd_disk *un;
struct diskhd *dp;
int i;
minor_t minor = getminor(bp->b_edev);
diskaddr_t p_lblksrt;
diskaddr_t lblocks;
diskaddr_t bn;
if ((un = ddi_get_soft_state(dcd_state,
minor >> DCDUNIT_SHIFT)) == NULL ||
un->un_state == DCD_STATE_DUMPING ||
((un->un_state & DCD_STATE_FATAL) == DCD_STATE_FATAL)) {
SET_BP_ERROR(bp, ((un) ? ENXIO : EIO));
error:
bp->b_resid = bp->b_bcount;
biodone(bp);
return (0);
}
if (bp->b_bcount > un->un_max_xfer_size) {
SET_BP_ERROR(bp, EINVAL);
goto error;
}
TRACE_2(TR_FAC_DADA, TR_DCDSTRATEGY_START,
"dcdstrategy_start: bp 0x%p un 0x%p", bp, un);
mutex_enter(DCD_MUTEX);
while (un->un_state == DCD_STATE_SUSPENDED) {
cv_wait(&un->un_suspend_cv, DCD_MUTEX);
}
if (un->un_state == DCD_STATE_PM_SUSPENDED) {
mutex_exit(DCD_MUTEX);
(void) pm_idle_component(DCD_DEVINFO, 0);
if (pm_raise_power(DCD_DEVINFO, 0,
DCD_DEVICE_ACTIVE) != DDI_SUCCESS) {
SET_BP_ERROR(bp, EIO);
goto error;
}
mutex_enter(DCD_MUTEX);
}
mutex_exit(DCD_MUTEX);
if (((uintptr_t)bp->b_un.b_addr) & 0x1)
bp_mapin(bp);
bp->b_flags &= ~(B_DONE|B_ERROR);
bp->b_resid = 0;
bp->av_forw = 0;
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"bp->b_bcount %lx\n", bp->b_bcount);
if (bp != un->un_sbufp) {
validated: if (cmlb_partinfo(un->un_dklbhandle,
minor & DCDPART_MASK,
&lblocks,
&p_lblksrt,
NULL,
NULL,
0) == 0) {
bn = dkblock(bp);
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"dkblock(bp) is %llu\n", bn);
i = 0;
if (bn < 0) {
i = -1;
} else if (bn >= lblocks) {
if (bn > lblocks) {
i = -1;
} else {
i = 1;
}
} else if (bp->b_bcount & (un->un_secsize-1)) {
i = -1;
} else {
if (!bp->b_bcount) {
printf("Waring : Zero read or Write\n");
goto error;
}
bp->b_resid = bn;
bp->b_resid += p_lblksrt;
bp->av_back = NO_PKT_ALLOCATED;
}
if (i != 0) {
if (i < 0) {
bp->b_flags |= B_ERROR;
}
goto error;
}
} else {
if (dcd_ready_and_valid(bp->b_edev, un) == 0) {
goto validated;
} else {
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
"i/o to invalid geometry\n");
SET_BP_ERROR(bp, EIO);
goto error;
}
}
} else if (BP_HAS_NO_PKT(bp)) {
struct udcd_cmd *tscmdp;
struct dcd_cmd *tcmdp;
tscmdp = (struct udcd_cmd *)bp->b_forw;
tcmdp = tscmdp->udcd_cmd;
if ((tcmdp->cmd != ATA_READ_DMA) && (tcmdp->cmd != 0xc9) &&
(tcmdp->cmd != ATA_WRITE_DMA) && (tcmdp->cmd != 0xcb) &&
(tcmdp->cmd != IDENTIFY_DMA) &&
(tcmdp->cmd != ATA_FLUSH_CACHE)) {
bp_mapin(bp);
}
}
mutex_enter(DCD_MUTEX);
DCD_DO_KSTATS(un, kstat_waitq_enter, bp);
dp = &un->un_utab;
if (dp->b_actf == NULL) {
dp->b_actf = bp;
dp->b_actl = bp;
} else if ((un->un_state == DCD_STATE_SUSPENDED) &&
bp == un->un_sbufp) {
bp->b_actf = dp->b_actf;
dp->b_actf = bp;
} else {
TRACE_3(TR_FAC_DADA, TR_DCDSTRATEGY_DISKSORT_START,
"dcdstrategy_disksort_start: dp 0x%p bp 0x%p un 0x%p",
dp, bp, un);
disksort(dp, bp);
TRACE_0(TR_FAC_DADA, TR_DCDSTRATEGY_DISKSORT_END,
"dcdstrategy_disksort_end");
}
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"ncmd %x , throttle %x, forw 0x%p\n",
un->un_ncmds, un->un_throttle, (void *)dp->b_forw);
ASSERT(un->un_ncmds >= 0);
ASSERT(un->un_throttle >= 0);
if ((un->un_ncmds < un->un_throttle) && (dp->b_forw == NULL)) {
dcdstart(un);
} else if (BP_HAS_NO_PKT(dp->b_actf)) {
struct buf *cmd_bp;
cmd_bp = dp->b_actf;
cmd_bp->av_back = ALLOCATING_PKT;
mutex_exit(DCD_MUTEX);
TRACE_0(TR_FAC_DADA, TR_DCDSTRATEGY_SMALL_WINDOW_START,
"dcdstrategy_small_window_call (begin)");
make_dcd_cmd(un, cmd_bp, NULL_FUNC);
TRACE_0(TR_FAC_DADA, TR_DCDSTRATEGY_SMALL_WINDOW_END,
"dcdstrategy_small_window_call (end)");
mutex_enter(DCD_MUTEX);
if ((un->un_ncmds < un->un_throttle) &&
(dp->b_forw == NULL)) {
dcdstart(un);
}
}
mutex_exit(DCD_MUTEX);
done:
TRACE_0(TR_FAC_DADA, TR_DCDSTRATEGY_END, "dcdstrategy_end");
return (0);
}
static void
dcdstart(struct dcd_disk *un)
{
int status, sort_key;
struct buf *bp;
struct diskhd *dp;
uchar_t state = un->un_last_state;
TRACE_1(TR_FAC_DADA, TR_DCDSTART_START, "dcdstart_start: un 0x%p", un);
retry:
ASSERT(mutex_owned(DCD_MUTEX));
dp = &un->un_utab;
if (((bp = dp->b_actf) == NULL) || (bp->av_back == ALLOCATING_PKT) ||
(dp->b_forw != NULL)) {
TRACE_0(TR_FAC_DADA, TR_DCDSTART_NO_WORK_END,
"dcdstart_end (no work)");
return;
}
dp->b_actf = bp->b_actf;
bp->b_actf = 0;
un->un_ncmds++;
DCD_DO_KSTATS(un, kstat_waitq_to_runq, bp);
mutex_exit(DCD_MUTEX);
if (BP_HAS_NO_PKT(bp)) {
make_dcd_cmd(un, bp, dcdrunout);
if (BP_HAS_NO_PKT(bp) && !(bp->b_flags & B_ERROR)) {
mutex_enter(DCD_MUTEX);
DCD_DO_KSTATS(un, kstat_runq_back_to_waitq, bp);
bp->b_actf = dp->b_actf;
dp->b_actf = bp;
New_state(un, DCD_STATE_RWAIT);
un->un_ncmds--;
TRACE_0(TR_FAC_DADA, TR_DCDSTART_NO_RESOURCES_END,
"dcdstart_end (No Resources)");
goto done;
} else if (bp->b_flags & B_ERROR) {
mutex_enter(DCD_MUTEX);
DCD_DO_KSTATS(un, kstat_runq_exit, bp);
un->un_ncmds--;
bp->b_resid = bp->b_bcount;
if (bp->b_error == 0) {
SET_BP_ERROR(bp, EIO);
}
un->un_state = un->un_last_state;
un->un_last_state = state;
mutex_exit(DCD_MUTEX);
biodone(bp);
mutex_enter(DCD_MUTEX);
if (un->un_state == DCD_STATE_SUSPENDED) {
cv_broadcast(&un->un_disk_busy_cv);
}
if ((un->un_ncmds < un->un_throttle) &&
(dp->b_forw == NULL)) {
goto retry;
} else {
goto done;
}
}
}
sort_key = bp->b_resid;
bp->b_resid = BP_PKT(bp)->pkt_resid;
BP_PKT(bp)->pkt_resid = 0;
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"bp->b_resid %lx, pkt_resid %lx\n",
bp->b_resid, BP_PKT(bp)->pkt_resid);
if ((status = dcd_transport((struct dcd_pkt *)BP_PKT(bp)))
!= TRAN_ACCEPT) {
mutex_enter(DCD_MUTEX);
un->un_ncmds--;
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"transport returned %x\n", status);
if (status == TRAN_BUSY) {
DCD_DO_ERRSTATS(un, dcd_transerrs);
DCD_DO_KSTATS(un, kstat_runq_back_to_waitq, bp);
dcd_handle_tran_busy(bp, dp, un);
if (un->un_ncmds > 0) {
bp->b_resid = sort_key;
}
} else {
DCD_DO_KSTATS(un, kstat_runq_exit, bp);
mutex_exit(DCD_MUTEX);
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
"transport rejected (%d)\n",
status);
SET_BP_ERROR(bp, EIO);
bp->b_resid = bp->b_bcount;
if (bp != un->un_sbufp) {
dcd_destroy_pkt(BP_PKT(bp));
}
biodone(bp);
mutex_enter(DCD_MUTEX);
if (un->un_state == DCD_STATE_SUSPENDED) {
cv_broadcast(&un->un_disk_busy_cv);
}
if ((un->un_ncmds < un->un_throttle) &&
(dp->b_forw == NULL)) {
goto retry;
}
}
} else {
mutex_enter(DCD_MUTEX);
if (dp->b_actf && BP_HAS_NO_PKT(dp->b_actf)) {
struct buf *cmd_bp;
cmd_bp = dp->b_actf;
cmd_bp->av_back = ALLOCATING_PKT;
mutex_exit(DCD_MUTEX);
TRACE_0(TR_FAC_DADA, TR_DCASTART_SMALL_WINDOW_START,
"dcdstart_small_window_start");
make_dcd_cmd(un, cmd_bp, NULL_FUNC);
TRACE_0(TR_FAC_DADA, TR_DCDSTART_SMALL_WINDOW_END,
"dcdstart_small_window_end");
mutex_enter(DCD_MUTEX);
if ((un->un_ncmds < un->un_throttle) &&
(dp->b_forw == NULL)) {
goto retry;
}
}
}
done:
ASSERT(mutex_owned(DCD_MUTEX));
TRACE_0(TR_FAC_DADA, TR_DCDSTART_END, "dcdstart_end");
}
static void
make_dcd_cmd(struct dcd_disk *un, struct buf *bp, int (*func)())
{
auto int count, com, direction;
struct dcd_pkt *pkt;
int flags, tval;
_NOTE(DATA_READABLE_WITHOUT_LOCK(dcd_disk::un_dp))
TRACE_3(TR_FAC_DADA, TR_MAKE_DCD_CMD_START,
"make_dcd_cmd_start: un 0x%p bp 0x%p un 0x%p", un, bp, un);
flags = un->un_cmd_flags;
if (bp != un->un_sbufp) {
int partition = DCDPART(bp->b_edev);
diskaddr_t p_lblksrt;
diskaddr_t lblocks;
long secnt;
uint32_t blkno;
int dkl_nblk, delta;
long resid;
if (cmlb_partinfo(un->un_dklbhandle,
partition,
&lblocks,
&p_lblksrt,
NULL,
NULL,
0) != 0) {
lblocks = 0;
p_lblksrt = 0;
}
dkl_nblk = (int)lblocks;
blkno = dkblock(bp);
secnt = (bp->b_bcount + (un->un_secsize - 1)) >> un->un_secdiv;
count = MIN(secnt, dkl_nblk - blkno);
if (count != secnt) {
resid = (secnt - count) << un->un_secdiv;
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"overrun by %ld sectors\n",
secnt - count);
bp->b_bcount -= resid;
} else {
resid = 0;
}
delta = (int)p_lblksrt;
blkno += delta;
mutex_enter(DCD_MUTEX);
if (un->un_lbasize != un->un_secsize) {
blkno >>= un->un_blknoshift;
count >>= un->un_blknoshift;
}
mutex_exit(DCD_MUTEX);
TRACE_0(TR_FAC_DADA, TR_MAKE_DCD_CMD_INIT_PKT_START,
"make_dcd_cmd_init_pkt_call (begin)");
pkt = dcd_init_pkt(ROUTE, NULL, bp,
(uint32_t)sizeof (struct dcd_cmd),
un->un_cmd_stat_size, PP_LEN, PKT_CONSISTENT,
func, (caddr_t)un);
TRACE_1(TR_FAC_DADA, TR_MAKE_DCD_CMD_INIT_PKT_END,
"make_dcd_cmd_init_pkt_call (end): pkt 0x%p", pkt);
if (!pkt) {
bp->b_bcount += resid;
bp->av_back = NO_PKT_ALLOCATED;
TRACE_0(TR_FAC_DADA,
TR_MAKE_DCD_CMD_NO_PKT_ALLOCATED1_END,
"make_dcd_cmd_end (NO_PKT_ALLOCATED1)");
return;
}
if (bp->b_flags & B_READ) {
if ((un->un_dp->options & DMA_SUPPORTTED) ==
DMA_SUPPORTTED) {
com = ATA_READ_DMA;
} else {
if (un->un_dp->options & BLOCK_MODE)
com = ATA_READ_MULTIPLE;
else
com = ATA_READ;
}
direction = DATA_READ;
} else {
if ((un->un_dp->options & DMA_SUPPORTTED) ==
DMA_SUPPORTTED) {
com = ATA_WRITE_DMA;
} else {
if (un->un_dp->options & BLOCK_MODE)
com = ATA_WRITE_MULTIPLE;
else
com = ATA_WRITE;
}
direction = DATA_WRITE;
}
pkt->pkt_resid = resid;
makecommand(pkt, flags, com, blkno, ADD_LBA_MODE,
bp->b_bcount, direction, 0);
tval = dcd_io_time;
} else {
struct udcd_cmd *scmd = (struct udcd_cmd *)bp->b_forw;
if ((scmd->udcd_flags & UDCD_SILENT) && !(DEBUGGING)) {
flags |= FLAG_SILENT;
}
if (scmd->udcd_flags & UDCD_DIAGNOSE)
flags |= FLAG_DIAGNOSE;
if (scmd->udcd_flags & UDCD_NOINTR)
flags |= FLAG_NOINTR;
pkt = dcd_init_pkt(ROUTE, (struct dcd_pkt *)NULL,
(bp->b_bcount)? bp: NULL,
(uint32_t)sizeof (struct dcd_cmd),
2, PP_LEN, PKT_CONSISTENT, func, (caddr_t)un);
if (!pkt) {
bp->av_back = NO_PKT_ALLOCATED;
return;
}
makecommand(pkt, 0, scmd->udcd_cmd->cmd,
scmd->udcd_cmd->sector_num.lba_num,
scmd->udcd_cmd->address_mode,
scmd->udcd_cmd->size,
scmd->udcd_cmd->direction, scmd->udcd_cmd->features);
pkt->pkt_flags = flags;
if (scmd->udcd_timeout == 0)
tval = dcd_io_time;
else
tval = scmd->udcd_timeout;
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"udcd interface\n");
}
pkt->pkt_comp = dcdintr;
pkt->pkt_time = tval;
PKT_SET_BP(pkt, bp);
bp->av_back = (struct buf *)pkt;
TRACE_0(TR_FAC_DADA, TR_MAKE_DCD_CMD_END, "make_dcd_cmd_end");
}
static void
dcdintr(struct dcd_pkt *pkt)
{
struct dcd_disk *un;
struct buf *bp;
int action;
int status;
bp = PKT_GET_BP(pkt);
un = ddi_get_soft_state(dcd_state, DCDUNIT(bp->b_edev));
TRACE_1(TR_FAC_DADA, TR_DCDINTR_START, "dcdintr_start: un 0x%p", un);
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG, "dcdintr\n");
mutex_enter(DCD_MUTEX);
un->un_ncmds--;
DCD_DO_KSTATS(un, kstat_runq_exit, bp);
ASSERT(un->un_ncmds >= 0);
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"reason %x and Status %x\n", pkt->pkt_reason, SCBP_C(pkt));
if ((pkt->pkt_reason == CMD_CMPLT) && (SCBP_C(pkt) == 0)) {
int com = GETATACMD((struct dcd_cmd *)pkt->pkt_cdbp);
if (un->un_state == DCD_STATE_OFFLINE) {
un->un_state = un->un_last_state;
dcd_log(DCD_DEVINFO, dcd_label, CE_NOTE,
(const char *) diskokay);
}
action = COMMAND_DONE;
if (pkt->pkt_resid && (com == ATA_READ || com == ATA_WRITE)) {
DCD_DO_ERRSTATS(un, dcd_harderrs);
if ((int)PKT_GET_RETRY_CNT(pkt) < dcd_retry_count) {
PKT_INCR_RETRY_CNT(pkt, 1);
action = QUE_COMMAND;
} else {
action = COMMAND_DONE_ERROR;
}
dcd_log(DCD_DEVINFO, dcd_label,
CE_WARN, "incomplete %s- %s\n",
(bp->b_flags & B_READ)? "read" : "write",
(action == QUE_COMMAND)? "retrying" :
"giving up");
}
if (action != QUE_COMMAND) {
bp->b_resid += pkt->pkt_resid;
}
} else if (pkt->pkt_reason != CMD_CMPLT) {
action = dcd_handle_incomplete(un, bp);
}
if (ddi_in_panic() && (action == QUE_COMMAND)) {
action = COMMAND_DONE_ERROR;
}
if ((un->un_last_pkt_reason != pkt->pkt_reason) &&
((pkt->pkt_reason != CMD_CMPLT) ||
(PKT_GET_RETRY_CNT(pkt) == 0))) {
un->un_last_pkt_reason = pkt->pkt_reason;
}
switch (action) {
case COMMAND_DONE_ERROR:
error:
if (bp->b_resid == 0) {
bp->b_resid = bp->b_bcount;
}
if (bp->b_error == 0) {
struct dcd_cmd *cdbp = (struct dcd_cmd *)pkt->pkt_cdbp;
if (cdbp->cmd == ATA_FLUSH_CACHE &&
(pkt->pkt_scbp[0] & STATUS_ATA_ERR) &&
(pkt->pkt_scbp[1] & ERR_ABORT)) {
SET_BP_ERROR(bp, ENOTSUP);
un->un_flush_not_supported = 1;
} else {
SET_BP_ERROR(bp, EIO);
}
}
bp->b_flags |= B_ERROR;
case COMMAND_DONE:
dcddone_and_mutex_exit(un, bp);
TRACE_0(TR_FAC_DADA, TR_DCDINTR_COMMAND_DONE_END,
"dcdintr_end (COMMAND_DONE)");
return;
case QUE_COMMAND:
if (un->un_ncmds >= un->un_throttle) {
struct diskhd *dp = &un->un_utab;
bp->b_actf = dp->b_actf;
dp->b_actf = bp;
DCD_DO_KSTATS(un, kstat_waitq_enter, bp);
mutex_exit(DCD_MUTEX);
goto exit;
}
un->un_ncmds++;
pkt->pkt_reason = 0;
DCD_DO_KSTATS(un, kstat_runq_enter, bp);
mutex_exit(DCD_MUTEX);
if ((status = dcd_transport(BP_PKT(bp))) != TRAN_ACCEPT) {
struct diskhd *dp = &un->un_utab;
mutex_enter(DCD_MUTEX);
un->un_ncmds--;
if (status == TRAN_BUSY) {
DCD_DO_KSTATS(un, kstat_runq_back_to_waitq, bp);
dcd_handle_tran_busy(bp, dp, un);
mutex_exit(DCD_MUTEX);
goto exit;
}
DCD_DO_ERRSTATS(un, dcd_transerrs);
DCD_DO_KSTATS(un, kstat_runq_exit, bp);
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
"requeue of command fails (%x)\n", status);
SET_BP_ERROR(bp, EIO);
bp->b_resid = bp->b_bcount;
dcddone_and_mutex_exit(un, bp);
goto exit;
}
break;
case JUST_RETURN:
default:
DCD_DO_KSTATS(un, kstat_waitq_enter, bp);
mutex_exit(DCD_MUTEX);
break;
}
exit:
TRACE_0(TR_FAC_DADA, TR_DCDINTR_END, "dcdintr_end");
}
static void
dcddone_and_mutex_exit(struct dcd_disk *un, register struct buf *bp)
{
struct diskhd *dp;
TRACE_1(TR_FAC_DADA, TR_DCDONE_START, "dcddone_start: un 0x%p", un);
_NOTE(LOCK_RELEASED_AS_SIDE_EFFECT(&un->un_dcd->dcd_mutex));
dp = &un->un_utab;
if (bp == dp->b_forw) {
dp->b_forw = NULL;
}
if (un->un_stats) {
ulong_t n_done = bp->b_bcount - bp->b_resid;
if (bp->b_flags & B_READ) {
IOSP->reads++;
IOSP->nread += n_done;
} else {
IOSP->writes++;
IOSP->nwritten += n_done;
}
}
if (IO_PARTITION_STATS) {
ulong_t n_done = bp->b_bcount - bp->b_resid;
if (bp->b_flags & B_READ) {
IOSP_PARTITION->reads++;
IOSP_PARTITION->nread += n_done;
} else {
IOSP_PARTITION->writes++;
IOSP_PARTITION->nwritten += n_done;
}
}
if (un->un_state == DCD_STATE_SUSPENDED) {
cv_broadcast(&un->un_disk_busy_cv);
} else if (dp->b_actf && (un->un_ncmds < un->un_throttle) &&
(dp->b_forw == NULL && un->un_state != DCD_STATE_SUSPENDED)) {
dcdstart(un);
}
mutex_exit(DCD_MUTEX);
if (bp != un->un_sbufp) {
dcd_destroy_pkt(BP_PKT(bp));
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"regular done: resid %ld\n", bp->b_resid);
} else {
ASSERT(un->un_sbuf_busy);
}
TRACE_0(TR_FAC_DADA, TR_DCDDONE_BIODONE_CALL, "dcddone_biodone_call");
biodone(bp);
(void) pm_idle_component(DCD_DEVINFO, 0);
TRACE_0(TR_FAC_DADA, TR_DCDDONE_END, "dcddone end");
}
#define C1 (STAT_ATA_BUS_RESET|STAT_ATA_DEV_RESET|STAT_ATA_ABORTED)
static void
dcd_reset_disk(struct dcd_disk *un, struct dcd_pkt *pkt)
{
if ((pkt->pkt_statistics & C1) == 0) {
mutex_exit(DCD_MUTEX);
if (!dcd_reset(ROUTE, RESET_ALL)) {
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"Reset failed");
}
mutex_enter(DCD_MUTEX);
}
}
static int
dcd_handle_incomplete(struct dcd_disk *un, struct buf *bp)
{
static char *fail = "ATA transport failed: reason '%s': %s\n";
static char *notresp = "disk not responding to selection\n";
int rval = COMMAND_DONE_ERROR;
int action = COMMAND_SOFT_ERROR;
struct dcd_pkt *pkt = BP_PKT(bp);
int be_chatty = (un->un_state != DCD_STATE_SUSPENDED) &&
(bp != un->un_sbufp || !(pkt->pkt_flags & FLAG_SILENT));
ASSERT(mutex_owned(DCD_MUTEX));
switch (pkt->pkt_reason) {
case CMD_TIMEOUT:
break;
case CMD_INCOMPLETE:
action = dcd_check_error(un, bp);
DCD_DO_ERRSTATS(un, dcd_transerrs);
if (action == COMMAND_HARD_ERROR) {
(void) dcd_reset_disk(un, pkt);
}
break;
case CMD_FATAL:
break;
case CMD_DMA_DERR:
case CMD_DATA_OVR:
default:
DCD_DO_ERRSTATS(un, dcd_transerrs);
if ((pkt->pkt_reason != CMD_RESET) &&
(pkt->pkt_reason != CMD_ABORTED)) {
(void) dcd_reset_disk(un, pkt);
}
break;
}
if ((pkt->pkt_reason == CMD_RESET) ||(pkt->pkt_reason == CMD_ABORTED)) {
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"Command aborted\n");
}
if (bp == un->un_sbufp && (pkt->pkt_flags & FLAG_DIAGNOSE)) {
rval = COMMAND_DONE_ERROR;
} else {
if ((rval == COMMAND_DONE_ERROR) &&
(action == COMMAND_SOFT_ERROR) &&
((int)PKT_GET_RETRY_CNT(pkt) < dcd_retry_count)) {
PKT_INCR_RETRY_CNT(pkt, 1);
rval = QUE_COMMAND;
}
}
if (pkt->pkt_reason == CMD_INCOMPLETE && rval == COMMAND_DONE_ERROR) {
if (un->un_state != DCD_STATE_OFFLINE) {
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
(const char *) notresp);
New_state(un, DCD_STATE_OFFLINE);
}
} else if (pkt->pkt_reason == CMD_FATAL) {
PKT_INCR_RETRY_CNT(pkt, 6);
rval = COMMAND_DONE_ERROR;
New_state(un, DCD_STATE_FATAL);
} else if (be_chatty) {
int in_panic = ddi_in_panic();
if (!in_panic || (rval == COMMAND_DONE_ERROR)) {
if (((pkt->pkt_reason != un->un_last_pkt_reason) &&
(pkt->pkt_reason != CMD_RESET)) ||
(rval == COMMAND_DONE_ERROR) ||
(dcd_error_level == DCD_ERR_ALL)) {
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
fail, dcd_rname(pkt->pkt_reason),
(rval == COMMAND_DONE_ERROR) ?
"giving up": "retrying command");
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"retrycount=%x\n",
PKT_GET_RETRY_CNT(pkt));
}
}
}
error:
return (rval);
}
static int
dcd_check_error(struct dcd_disk *un, struct buf *bp)
{
struct diskhd *dp = &un->un_utab;
struct dcd_pkt *pkt = BP_PKT(bp);
int rval = 0;
unsigned char status;
unsigned char error;
TRACE_0(TR_FAC_DADA, TR_DCD_CHECK_ERROR_START, "dcd_check_error_start");
ASSERT(mutex_owned(DCD_MUTEX));
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"Pkt: 0x%p dp: 0x%p\n", (void *)pkt, (void *)dp);
status = (pkt->pkt_scbp)[0];
if ((status & STATUS_ATA_DWF) == STATUS_ATA_DWF) {
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN, "Device Fault\n");
rval = COMMAND_HARD_ERROR;
} else if ((status & STATUS_ATA_CORR) == STATUS_ATA_CORR) {
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
"Soft Error on block %x\n",
((struct dcd_cmd *)pkt->pkt_cdbp)->sector_num.lba_num);
rval = COMMAND_SOFT_ERROR;
} else if ((status & STATUS_ATA_ERR) == STATUS_ATA_ERR) {
error = pkt->pkt_scbp[1];
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
"Command:0x%x,Error:0x%x,Status:0x%x\n",
GETATACMD((struct dcd_cmd *)pkt->pkt_cdbp),
error, status);
if ((error & ERR_AMNF) == ERR_AMNF) {
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
"Address Mark Not Found");
} else if ((error & ERR_TKONF) == ERR_TKONF) {
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
"Track 0 Not found \n");
} else if ((error & ERR_IDNF) == ERR_IDNF) {
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
" ID not found \n");
} else if ((error & ERR_UNC) == ERR_UNC) {
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
"Uncorrectable data Error: Block %x\n",
((struct dcd_cmd *)pkt->pkt_cdbp)->
sector_num.lba_num);
} else if ((error & ERR_BBK) == ERR_BBK) {
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
"Bad block detected: Block %x\n",
((struct dcd_cmd *)pkt->pkt_cdbp)->
sector_num.lba_num);
} else if ((error & ERR_ABORT) == ERR_ABORT) {
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
" Aborted Command \n");
}
rval = COMMAND_SOFT_ERROR;
}
TRACE_0(TR_FAC_DADA, TR_DCD_CHECK_ERROR_END, "dcd_check_error_end");
return (rval);
}
#define NDUMP_RETRIES 5
static int
dcddump(dev_t dev, caddr_t addr, daddr_t blkno, int nblk)
{
struct dcd_pkt *pkt;
int i;
struct buf local, *bp;
int err;
unsigned char com;
diskaddr_t p_lblksrt;
diskaddr_t lblocks;
GET_SOFT_STATE(dev);
#ifdef lint
part = part;
#endif
_NOTE(NOW_INVISIBLE_TO_OTHER_THREADS(*un))
if ((un->un_state & DCD_STATE_FATAL) == DCD_STATE_FATAL)
return (ENXIO);
if (cmlb_partinfo(un->un_dklbhandle, DCDPART(dev),
&lblocks, &p_lblksrt, NULL, NULL, 0))
return (ENXIO);
if (blkno+nblk > lblocks) {
return (EINVAL);
}
if ((un->un_state == DCD_STATE_SUSPENDED) ||
(un->un_state == DCD_STATE_PM_SUSPENDED)) {
if (pm_raise_power(DCD_DEVINFO, 0,
DCD_DEVICE_ACTIVE) != DDI_SUCCESS) {
return (EIO);
}
}
un->un_throttle = 0;
if ((un->un_state != DCD_STATE_SUSPENDED) &&
(un->un_state != DCD_STATE_DUMPING)) {
New_state(un, DCD_STATE_DUMPING);
if (dcd_reset(ROUTE, RESET_ALL) == 0) {
return (EIO);
}
}
blkno += p_lblksrt;
bp = &local;
bzero((caddr_t)bp, sizeof (*bp));
bp->b_flags = B_BUSY;
bp->b_un.b_addr = addr;
bp->b_bcount = nblk << DEV_BSHIFT;
bp->b_resid = 0;
for (i = 0; i < NDUMP_RETRIES; i++) {
bp->b_flags &= ~B_ERROR;
if ((pkt = dcd_init_pkt(ROUTE, NULL, bp,
(uint32_t)sizeof (struct dcd_cmd), 2, PP_LEN,
PKT_CONSISTENT, NULL_FUNC, NULL)) != NULL) {
break;
}
if (i == 0) {
if (bp->b_flags & B_ERROR) {
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
"no resources for dumping; "
"error code: 0x%x, retrying",
geterror(bp));
} else {
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
"no resources for dumping; retrying");
}
} else if (i != (NDUMP_RETRIES - 1)) {
if (bp->b_flags & B_ERROR) {
dcd_log(DCD_DEVINFO, dcd_label, CE_CONT, "no "
"resources for dumping; error code: 0x%x, "
"retrying\n", geterror(bp));
}
} else {
if (bp->b_flags & B_ERROR) {
dcd_log(DCD_DEVINFO, dcd_label, CE_CONT,
"no resources for dumping; "
"error code: 0x%x, retries failed, "
"giving up.\n", geterror(bp));
} else {
dcd_log(DCD_DEVINFO, dcd_label, CE_CONT,
"no resources for dumping; "
"retries failed, giving up.\n");
}
return (EIO);
}
delay(10);
}
if ((un->un_dp->options & DMA_SUPPORTTED) == DMA_SUPPORTTED) {
com = ATA_WRITE_DMA;
} else {
if (un->un_dp->options & BLOCK_MODE)
com = ATA_WRITE_MULTIPLE;
else
com = ATA_WRITE;
}
makecommand(pkt, 0, com, blkno, ADD_LBA_MODE,
(int)nblk*un->un_secsize, DATA_WRITE, 0);
for (err = EIO, i = 0; i < NDUMP_RETRIES && err == EIO; i++) {
if (dcd_poll(pkt) == 0) {
switch (SCBP_C(pkt)) {
case STATUS_GOOD:
if (pkt->pkt_resid == 0) {
err = 0;
}
break;
case STATUS_ATA_BUSY:
(void) dcd_reset(ROUTE, RESET_TARGET);
break;
default:
mutex_enter(DCD_MUTEX);
(void) dcd_reset_disk(un, pkt);
mutex_exit(DCD_MUTEX);
break;
}
} else if (i > NDUMP_RETRIES/2) {
(void) dcd_reset(ROUTE, RESET_ALL);
}
}
dcd_destroy_pkt(pkt);
return (err);
}
static int
dcdioctl(dev_t dev, int cmd, intptr_t arg, int flag,
cred_t *cred_p, int *rval_p)
{
auto int32_t data[512 / (sizeof (int32_t))];
struct dk_cinfo *info;
struct dk_minfo media_info;
struct udcd_cmd *scmd;
int i, err;
enum uio_seg uioseg = 0;
enum dkio_state state = 0;
#ifdef _MULTI_DATAMODEL
struct dadkio_rwcmd rwcmd;
#endif
struct dadkio_rwcmd32 rwcmd32;
struct dcd_cmd dcdcmd;
GET_SOFT_STATE(dev);
#ifdef lint
part = part;
state = state;
uioseg = uioseg;
#endif
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"dcd_ioctl : cmd %x, arg %lx\n", cmd, arg);
bzero((caddr_t)data, sizeof (data));
switch (cmd) {
#ifdef DCDDEBUG
#define DKIOCRESET (DKIOC|14)
#define DKIOCABORT (DKIOC|15)
case DKIOCRESET:
if (ddi_copyin((caddr_t)arg, (caddr_t)data, 4, flag))
return (EFAULT);
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"DKIOCRESET: data = 0x%x\n", data[0]);
if (dcd_reset(ROUTE, data[0])) {
return (0);
} else {
return (EIO);
}
case DKIOCABORT:
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"DKIOCABORT:\n");
if (dcd_abort(ROUTE, (struct dcd_pkt *)0)) {
return (0);
} else {
return (EIO);
}
#endif
case DKIOCINFO:
info = (struct dk_cinfo *)data;
mutex_enter(DCD_MUTEX);
switch (un->un_dp->ctype) {
default:
info->dki_ctype = DKC_DIRECT;
break;
}
mutex_exit(DCD_MUTEX);
info->dki_cnum = ddi_get_instance(ddi_get_parent(DCD_DEVINFO));
(void) strcpy(info->dki_cname,
ddi_get_name(ddi_get_parent(DCD_DEVINFO)));
info->dki_unit = ddi_get_instance(DCD_DEVINFO);
info->dki_slave = (Tgt(DCD_DCD_DEVP)<<3);
(void) strcpy(info->dki_dname, ddi_driver_name(DCD_DEVINFO));
info->dki_flags = DKI_FMTVOL;
info->dki_partition = DCDPART(dev);
info->dki_maxtransfer = un->un_max_xfer_size / DEV_BSIZE;
info->dki_addr = 0;
info->dki_space = 0;
info->dki_prio = 0;
info->dki_vec = 0;
i = sizeof (struct dk_cinfo);
if (ddi_copyout((caddr_t)data, (caddr_t)arg, i, flag))
return (EFAULT);
else
return (0);
case DKIOCGMEDIAINFO:
media_info.dki_media_type = DK_FIXED_DISK;
mutex_enter(DCD_MUTEX);
media_info.dki_lbsize = un->un_lbasize;
media_info.dki_capacity = un->un_diskcapacity;
mutex_exit(DCD_MUTEX);
if (ddi_copyout(&media_info, (caddr_t)arg,
sizeof (struct dk_minfo), flag))
return (EFAULT);
else
return (0);
case DKIOCGGEOM:
case DKIOCGVTOC:
case DKIOCGETEFI:
mutex_enter(DCD_MUTEX);
if (un->un_ncmds == 0) {
if ((err = dcd_unit_ready(dev)) != 0) {
mutex_exit(DCD_MUTEX);
return (err);
}
}
mutex_exit(DCD_MUTEX);
err = cmlb_ioctl(un->un_dklbhandle, dev, cmd,
arg, flag, cred_p, rval_p, 0);
return (err);
case DKIOCGAPART:
case DKIOCSAPART:
case DKIOCSGEOM:
case DKIOCSVTOC:
case DKIOCSETEFI:
case DKIOCPARTITION:
case DKIOCPARTINFO:
case DKIOCGMBOOT:
case DKIOCSMBOOT:
err = cmlb_ioctl(un->un_dklbhandle, dev, cmd,
arg, flag, cred_p, rval_p, 0);
return (err);
case DIOCTL_RWCMD:
if (drv_priv(cred_p) != 0) {
return (EPERM);
}
#ifdef _MULTI_DATAMODEL
switch (ddi_model_convert_from(flag & FMODELS)) {
case DDI_MODEL_NONE:
if (ddi_copyin((caddr_t)arg, (caddr_t)&rwcmd,
sizeof (struct dadkio_rwcmd), flag)) {
return (EFAULT);
}
rwcmd32.cmd = rwcmd.cmd;
rwcmd32.flags = rwcmd.flags;
rwcmd32.blkaddr = rwcmd.blkaddr;
rwcmd32.buflen = rwcmd.buflen;
rwcmd32.bufaddr = (caddr32_t)(uintptr_t)rwcmd.bufaddr;
break;
case DDI_MODEL_ILP32:
if (ddi_copyin((caddr_t)arg, (caddr_t)&rwcmd32,
sizeof (struct dadkio_rwcmd32), flag)) {
return (EFAULT);
}
break;
}
#else
if (ddi_copyin((caddr_t)arg, (caddr_t)&rwcmd32,
sizeof (struct dadkio_rwcmd32), flag)) {
return (EFAULT);
}
#endif
mutex_enter(DCD_MUTEX);
uioseg = UIO_SYSSPACE;
scmd = (struct udcd_cmd *)data;
scmd->udcd_cmd = &dcdcmd;
if (rwcmd32.cmd == DADKIO_RWCMD_READ) {
if ((un->un_dp->options & DMA_SUPPORTTED) ==
DMA_SUPPORTTED)
scmd->udcd_cmd->cmd = ATA_READ_DMA;
else
scmd->udcd_cmd->cmd = ATA_READ;
scmd->udcd_cmd->address_mode = ADD_LBA_MODE;
scmd->udcd_cmd->direction = DATA_READ;
scmd->udcd_flags |= UDCD_READ|UDCD_SILENT;
} else if (rwcmd32.cmd == DADKIO_RWCMD_WRITE) {
if ((un->un_dp->options & DMA_SUPPORTTED) ==
DMA_SUPPORTTED)
scmd->udcd_cmd->cmd = ATA_WRITE_DMA;
else
scmd->udcd_cmd->cmd = ATA_WRITE;
scmd->udcd_cmd->direction = DATA_WRITE;
scmd->udcd_flags |= UDCD_WRITE|UDCD_SILENT;
} else {
mutex_exit(DCD_MUTEX);
return (EINVAL);
}
scmd->udcd_cmd->address_mode = ADD_LBA_MODE;
scmd->udcd_cmd->features = 0;
scmd->udcd_cmd->size = rwcmd32.buflen;
scmd->udcd_cmd->sector_num.lba_num = rwcmd32.blkaddr;
scmd->udcd_bufaddr = (caddr_t)(uintptr_t)rwcmd32.bufaddr;
scmd->udcd_buflen = rwcmd32.buflen;
scmd->udcd_timeout = (ushort_t)dcd_io_time;
scmd->udcd_resid = 0ULL;
scmd->udcd_status = 0;
scmd->udcd_error_reg = 0;
scmd->udcd_status_reg = 0;
mutex_exit(DCD_MUTEX);
i = dcdioctl_cmd(dev, scmd, UIO_SYSSPACE, UIO_USERSPACE);
mutex_enter(DCD_MUTEX);
(void) dcd_translate(&(rwcmd32.status), scmd);
rwcmd32.status.resid = scmd->udcd_resid;
mutex_exit(DCD_MUTEX);
#ifdef _MULTI_DATAMODEL
switch (ddi_model_convert_from(flag & FMODELS)) {
case DDI_MODEL_NONE: {
int counter;
rwcmd.status.status = rwcmd32.status.status;
rwcmd.status.resid = rwcmd32.status.resid;
rwcmd.status.failed_blk_is_valid =
rwcmd32.status.failed_blk_is_valid;
rwcmd.status.failed_blk = rwcmd32.status.failed_blk;
rwcmd.status.fru_code_is_valid =
rwcmd32.status.fru_code_is_valid;
rwcmd.status.fru_code = rwcmd32.status.fru_code;
for (counter = 0;
counter < DADKIO_ERROR_INFO_LEN; counter++)
rwcmd.status.add_error_info[counter] =
rwcmd32.status.add_error_info[counter];
}
if (ddi_copyout((caddr_t)&rwcmd, (caddr_t)arg,
sizeof (struct dadkio_rwcmd), flag)) {
if (i != 0) {
i = EFAULT;
}
}
break;
case DDI_MODEL_ILP32:
if (ddi_copyout((caddr_t)&rwcmd32, (caddr_t)arg,
sizeof (struct dadkio_rwcmd32), flag)) {
if (i != 0) {
i = EFAULT;
}
}
break;
}
#else
if (ddi_copyout((caddr_t)&rwcmd32, (caddr_t)arg,
sizeof (struct dadkio_rwcmd32), flag)) {
if (i != 0)
i = EFAULT;
}
#endif
return (i);
case UDCDCMD: {
#ifdef _MULTI_DATAMODEL
struct udcd_cmd32 udcd_cmd_32_for_64;
struct udcd_cmd32 *ucmd32 = &udcd_cmd_32_for_64;
model_t model;
#endif
if (drv_priv(cred_p) != 0) {
return (EPERM);
}
scmd = (struct udcd_cmd *)data;
#ifdef _MULTI_DATAMODEL
switch (model = ddi_model_convert_from(flag & FMODELS)) {
case DDI_MODEL_ILP32:
if (ddi_copyin((caddr_t)arg, ucmd32,
sizeof (struct udcd_cmd32), flag)) {
return (EFAULT);
}
udcd_cmd32toudcd_cmd(ucmd32, scmd);
break;
case DDI_MODEL_NONE:
if (ddi_copyin((caddr_t)arg, scmd, sizeof (*scmd),
flag)) {
return (EFAULT);
}
break;
}
#else
if (ddi_copyin((caddr_t)arg, (caddr_t)scmd,
sizeof (*scmd), flag)) {
return (EFAULT);
}
#endif
scmd->udcd_flags &= ~UDCD_NOINTR;
uioseg = (flag & FKIOCTL)? UIO_SYSSPACE: UIO_USERSPACE;
i = dcdioctl_cmd(dev, scmd, uioseg, uioseg);
#ifdef _MULTI_DATAMODEL
switch (model) {
case DDI_MODEL_ILP32:
udcd_cmdtoudcd_cmd32(scmd, ucmd32);
if (ddi_copyout(ucmd32, (caddr_t)arg,
sizeof (*ucmd32), flag)) {
if (i != 0)
i = EFAULT;
}
break;
case DDI_MODEL_NONE:
if (ddi_copyout(scmd, (caddr_t)arg, sizeof (*scmd),
flag)) {
if (i != 0)
i = EFAULT;
}
break;
}
#else
if (ddi_copyout((caddr_t)scmd, (caddr_t)arg,
sizeof (*scmd), flag)) {
if (i != 0)
i = EFAULT;
}
#endif
return (i);
}
case DKIOCFLUSHWRITECACHE: {
struct dk_callback *dkc = (struct dk_callback *)arg;
struct dcd_pkt *pkt;
struct buf *bp;
int is_sync = 1;
mutex_enter(DCD_MUTEX);
if (un->un_flush_not_supported ||
! un->un_write_cache_enabled) {
i = un->un_flush_not_supported ? ENOTSUP : 0;
mutex_exit(DCD_MUTEX);
if ((flag & FKIOCTL) && dkc != NULL &&
dkc->dkc_callback != NULL) {
(*dkc->dkc_callback)(dkc->dkc_cookie, i);
i = 0;
}
return (i);
}
while (un->un_sbuf_busy) {
cv_wait(&un->un_sbuf_cv, DCD_MUTEX);
}
un->un_sbuf_busy = 1;
bp = un->un_sbufp;
mutex_exit(DCD_MUTEX);
pkt = dcd_init_pkt(ROUTE, (struct dcd_pkt *)NULL,
NULL, (uint32_t)sizeof (struct dcd_cmd),
2, PP_LEN, PKT_CONSISTENT, SLEEP_FUNC, (caddr_t)un);
ASSERT(pkt != NULL);
makecommand(pkt, un->un_cmd_flags | FLAG_SILENT,
ATA_FLUSH_CACHE, 0, ADD_LBA_MODE, 0, NO_DATA_XFER, 0);
pkt->pkt_comp = dcdintr;
pkt->pkt_time = DCD_FLUSH_TIME;
PKT_SET_BP(pkt, bp);
bp->av_back = (struct buf *)pkt;
bp->b_forw = NULL;
bp->b_flags = B_BUSY;
bp->b_error = 0;
bp->b_edev = dev;
bp->b_dev = cmpdev(dev);
bp->b_bcount = 0;
bp->b_blkno = 0;
bp->b_un.b_addr = 0;
bp->b_iodone = NULL;
bp->b_list = NULL;
bp->b_private = NULL;
if ((flag & FKIOCTL) && dkc != NULL &&
dkc->dkc_callback != NULL) {
struct dk_callback *dkc2 = (struct dk_callback *)
kmem_zalloc(sizeof (*dkc2), KM_SLEEP);
bcopy(dkc, dkc2, sizeof (*dkc2));
bp->b_private = dkc2;
bp->b_iodone = dcdflushdone;
is_sync = 0;
}
(void) dcdstrategy(bp);
i = 0;
if (is_sync) {
i = biowait(bp);
(void) dcdflushdone(bp);
}
return (i);
}
default:
break;
}
return (ENOTTY);
}
static int
dcdflushdone(struct buf *bp)
{
struct dcd_disk *un = ddi_get_soft_state(dcd_state,
DCDUNIT(bp->b_edev));
struct dcd_pkt *pkt = BP_PKT(bp);
struct dk_callback *dkc = bp->b_private;
ASSERT(un != NULL);
ASSERT(bp == un->un_sbufp);
ASSERT(pkt != NULL);
dcd_destroy_pkt(pkt);
bp->av_back = NO_PKT_ALLOCATED;
if (dkc != NULL) {
ASSERT(bp->b_iodone != NULL);
(*dkc->dkc_callback)(dkc->dkc_cookie, geterror(bp));
kmem_free(dkc, sizeof (*dkc));
bp->b_iodone = NULL;
bp->b_private = NULL;
}
mutex_enter(DCD_MUTEX);
un->un_sbuf_busy = 0;
cv_signal(&un->un_sbuf_cv);
mutex_exit(DCD_MUTEX);
return (0);
}
static int
dcdrunout(caddr_t arg)
{
int serviced;
struct dcd_disk *un;
struct diskhd *dp;
TRACE_1(TR_FAC_DADA, TR_DCDRUNOUT_START, "dcdrunout_start: arg 0x%p",
arg);
serviced = 1;
un = (struct dcd_disk *)arg;
dp = &un->un_utab;
ASSERT(un != NULL);
mutex_enter(DCD_MUTEX);
if ((un->un_ncmds < un->un_throttle) && (dp->b_forw == NULL)) {
dcdstart(un);
}
if (un->un_state == DCD_STATE_RWAIT) {
serviced = 0;
}
mutex_exit(DCD_MUTEX);
TRACE_1(TR_FAC_DADA, TR_DCDRUNOUT_END,
"dcdrunout_end: serviced %d", serviced);
return (serviced);
}
static int
dcd_unit_ready(dev_t dev)
{
#ifndef lint
auto struct udcd_cmd dcmd, *com = &dcmd;
auto struct dcd_cmd cmdblk;
#endif
int error;
#ifndef lint
GET_SOFT_STATE(dev);
#endif
error = 0;
return (error);
}
int
dcdioctl_cmd(dev_t devp, struct udcd_cmd *in, enum uio_seg cdbspace,
enum uio_seg dataspace)
{
struct buf *bp;
struct udcd_cmd *scmd;
struct dcd_pkt *pkt;
int err, rw;
caddr_t cdb;
int flags = 0;
GET_SOFT_STATE(devp);
#ifdef lint
part = part;
#endif
if (in->udcd_flags & UDCD_RESET) {
int flag = RESET_TARGET;
err = dcd_reset(ROUTE, flag) ? 0: EIO;
return (err);
}
scmd = in;
if (scmd->udcd_buflen <= 0) {
if (scmd->udcd_flags & (UDCD_READ | UDCD_WRITE)) {
return (EINVAL);
} else {
scmd->udcd_buflen = 0;
}
}
cdb = kmem_zalloc(sizeof (struct dcd_cmd), KM_SLEEP);
if (cdbspace == UIO_SYSSPACE) {
flags |= FKIOCTL;
}
if (ddi_copyin((void *)scmd->udcd_cmd, cdb, sizeof (struct dcd_cmd),
flags)) {
kmem_free(cdb, sizeof (struct dcd_cmd));
return (EFAULT);
}
scmd = (struct udcd_cmd *)kmem_alloc(sizeof (*scmd), KM_SLEEP);
bcopy((caddr_t)in, (caddr_t)scmd, sizeof (*scmd));
scmd->udcd_cmd = (struct dcd_cmd *)cdb;
rw = (scmd->udcd_flags & UDCD_READ) ? B_READ: B_WRITE;
mutex_enter(DCD_MUTEX);
while (un->un_sbuf_busy) {
if (cv_wait_sig(&un->un_sbuf_cv, DCD_MUTEX) == 0) {
kmem_free(scmd->udcd_cmd, sizeof (struct dcd_cmd));
kmem_free((caddr_t)scmd, sizeof (*scmd));
mutex_exit(DCD_MUTEX);
return (EINTR);
}
}
un->un_sbuf_busy = 1;
bp = un->un_sbufp;
mutex_exit(DCD_MUTEX);
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"dcdioctl_cmd : buflen %x\n", scmd->udcd_buflen);
if (scmd->udcd_buflen) {
auto struct iovec aiov;
auto struct uio auio;
struct uio *uio = &auio;
bzero((caddr_t)&auio, sizeof (struct uio));
bzero((caddr_t)&aiov, sizeof (struct iovec));
aiov.iov_base = scmd->udcd_bufaddr;
aiov.iov_len = scmd->udcd_buflen;
uio->uio_iov = &aiov;
uio->uio_iovcnt = 1;
uio->uio_resid = scmd->udcd_buflen;
uio->uio_segflg = dataspace;
bp->av_back = NO_PKT_ALLOCATED;
bp->b_forw = (struct buf *)scmd;
err = physio(dcdstrategy, bp, devp, rw, dcdudcdmin, uio);
} else {
bp->av_back = NO_PKT_ALLOCATED;
bp->b_forw = (struct buf *)scmd;
bp->b_flags = B_BUSY | rw;
bp->b_edev = devp;
bp->b_dev = cmpdev(devp);
bp->b_bcount = bp->b_blkno = 0;
(void) dcdstrategy(bp);
err = biowait(bp);
}
done:
if ((pkt = BP_PKT(bp)) != NULL) {
bp->av_back = NO_PKT_ALLOCATED;
in->udcd_resid = bp->b_resid;
in->udcd_status_reg = SCBP_C(pkt);
dcd_destroy_pkt(pkt);
}
mutex_enter(DCD_MUTEX);
un->un_sbuf_busy = 0;
cv_signal(&un->un_sbuf_cv);
mutex_exit(DCD_MUTEX);
kmem_free(scmd->udcd_cmd, sizeof (struct dcd_cmd));
kmem_free((caddr_t)scmd, sizeof (*scmd));
return (err);
}
static void
dcdudcdmin(struct buf *bp)
{
#ifdef lint
bp = bp;
#endif
}
void
dcdrestart(void *arg)
{
struct dcd_disk *un = (struct dcd_disk *)arg;
struct buf *bp;
int status;
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG, "dcdrestart\n");
mutex_enter(DCD_MUTEX);
bp = un->un_utab.b_forw;
if (bp) {
un->un_ncmds++;
DCD_DO_KSTATS(un, kstat_waitq_to_runq, bp);
}
if (bp) {
struct dcd_pkt *pkt = BP_PKT(bp);
mutex_exit(DCD_MUTEX);
pkt->pkt_flags = 0;
if ((status = dcd_transport(pkt)) != TRAN_ACCEPT) {
mutex_enter(DCD_MUTEX);
DCD_DO_KSTATS(un, kstat_runq_back_to_waitq, bp);
un->un_ncmds--;
if (status == TRAN_BUSY) {
un->un_reissued_timeid =
timeout(dcdrestart, (caddr_t)un,
DCD_BSY_TIMEOUT/500);
mutex_exit(DCD_MUTEX);
return;
}
DCD_DO_ERRSTATS(un, dcd_transerrs);
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
"dcdrestart transport failed (%x)\n", status);
bp->b_resid = bp->b_bcount;
SET_BP_ERROR(bp, EIO);
DCD_DO_KSTATS(un, kstat_waitq_exit, bp);
un->un_reissued_timeid = 0L;
dcddone_and_mutex_exit(un, bp);
return;
}
mutex_enter(DCD_MUTEX);
}
un->un_reissued_timeid = 0L;
mutex_exit(DCD_MUTEX);
DAD_DEBUG(DCD_DEVINFO, dcd_label, DCD_DEBUG, "dcdrestart done\n");
}
void
dcd_reset_throttle(caddr_t arg)
{
struct dcd_disk *un = (struct dcd_disk *)arg;
struct diskhd *dp;
mutex_enter(DCD_MUTEX);
dp = &un->un_utab;
if (dp->b_actf && (un->un_ncmds < un->un_throttle) &&
(dp->b_forw == NULL)) {
dcdstart(un);
}
mutex_exit(DCD_MUTEX);
}
static void
dcd_handle_tran_busy(struct buf *bp, struct diskhd *dp, struct dcd_disk *un)
{
ASSERT(mutex_owned(DCD_MUTEX));
if (dp->b_forw == NULL || dp->b_forw == bp) {
dp->b_forw = bp;
} else if (dp->b_forw != bp) {
bp->b_actf = dp->b_actf;
dp->b_actf = bp;
}
if (!un->un_reissued_timeid) {
un->un_reissued_timeid =
timeout(dcdrestart, (caddr_t)un, DCD_BSY_TIMEOUT/500);
}
}
static int
dcd_write_deviceid(struct dcd_disk *un)
{
int status;
diskaddr_t blk;
struct udcd_cmd ucmd;
struct dcd_cmd cdb;
struct dk_devid *dkdevid;
uint_t *ip, chksum;
int i;
dev_t dev;
mutex_exit(DCD_MUTEX);
if (cmlb_get_devid_block(un->un_dklbhandle, &blk, 0)) {
mutex_enter(DCD_MUTEX);
return (EINVAL);
}
mutex_enter(DCD_MUTEX);
dkdevid = kmem_zalloc(un->un_secsize, KM_SLEEP);
dkdevid->dkd_rev_hi = DK_DEVID_REV_MSB;
dkdevid->dkd_rev_lo = DK_DEVID_REV_LSB;
bcopy(un->un_devid, &dkdevid->dkd_devid,
ddi_devid_sizeof(un->un_devid));
chksum = 0;
ip = (uint_t *)dkdevid;
for (i = 0; i < ((un->un_secsize - sizeof (int))/sizeof (int)); i++)
chksum ^= ip[i];
DKD_FORMCHKSUM(chksum, dkdevid);
(void) bzero((caddr_t)&ucmd, sizeof (ucmd));
(void) bzero((caddr_t)&cdb, sizeof (struct dcd_cmd));
if ((un->un_dp->options & DMA_SUPPORTTED) == DMA_SUPPORTTED) {
cdb.cmd = ATA_WRITE_DMA;
} else {
if (un->un_dp->options & BLOCK_MODE)
cdb.cmd = ATA_WRITE_MULTIPLE;
else
cdb.cmd = ATA_WRITE;
}
cdb.size = un->un_secsize;
cdb.sector_num.lba_num = blk;
cdb.address_mode = ADD_LBA_MODE;
cdb.direction = DATA_WRITE;
ucmd.udcd_flags = UDCD_WRITE;
ucmd.udcd_cmd = &cdb;
ucmd.udcd_bufaddr = (caddr_t)dkdevid;
ucmd.udcd_buflen = un->un_secsize;
ucmd.udcd_flags |= UDCD_SILENT;
dev = makedevice(ddi_driver_major(DCD_DEVINFO),
ddi_get_instance(DCD_DEVINFO) << DCDUNIT_SHIFT);
mutex_exit(DCD_MUTEX);
status = dcdioctl_cmd(dev, &ucmd, UIO_SYSSPACE, UIO_SYSSPACE);
mutex_enter(DCD_MUTEX);
kmem_free(dkdevid, un->un_secsize);
return (status);
}
static int
dcd_read_deviceid(struct dcd_disk *un)
{
int status;
diskaddr_t blk;
struct udcd_cmd ucmd;
struct dcd_cmd cdb;
struct dk_devid *dkdevid;
uint_t *ip;
int chksum;
int i, sz;
dev_t dev;
mutex_exit(DCD_MUTEX);
if (cmlb_get_devid_block(un->un_dklbhandle, &blk, 0)) {
mutex_enter(DCD_MUTEX);
return (EINVAL);
}
mutex_enter(DCD_MUTEX);
dkdevid = kmem_alloc(un->un_secsize, KM_SLEEP);
(void) bzero((caddr_t)&ucmd, sizeof (ucmd));
(void) bzero((caddr_t)&cdb, sizeof (cdb));
if ((un->un_dp->options & DMA_SUPPORTTED) == DMA_SUPPORTTED) {
cdb.cmd = ATA_READ_DMA;
} else {
if (un->un_dp->options & BLOCK_MODE)
cdb.cmd = ATA_READ_MULTIPLE;
else
cdb.cmd = ATA_READ;
}
cdb.size = un->un_secsize;
cdb.sector_num.lba_num = blk;
cdb.address_mode = ADD_LBA_MODE;
cdb.direction = DATA_READ;
ucmd.udcd_flags = UDCD_READ;
ucmd.udcd_cmd = &cdb;
ucmd.udcd_bufaddr = (caddr_t)dkdevid;
ucmd.udcd_buflen = un->un_secsize;
ucmd.udcd_flags |= UDCD_SILENT;
dev = makedevice(ddi_driver_major(DCD_DEVINFO),
ddi_get_instance(DCD_DEVINFO) << DCDUNIT_SHIFT);
mutex_exit(DCD_MUTEX);
status = dcdioctl_cmd(dev, &ucmd, UIO_SYSSPACE, UIO_SYSSPACE);
mutex_enter(DCD_MUTEX);
if (status != 0) {
kmem_free((caddr_t)dkdevid, un->un_secsize);
return (status);
}
if ((dkdevid->dkd_rev_hi != DK_DEVID_REV_MSB) ||
(dkdevid->dkd_rev_lo != DK_DEVID_REV_LSB)) {
kmem_free((caddr_t)dkdevid, un->un_secsize);
return (EINVAL);
}
chksum = 0;
ip = (uint_t *)dkdevid;
for (i = 0; i < ((un->un_secsize - sizeof (int))/sizeof (int)); i++)
chksum ^= ip[i];
if (DKD_GETCHKSUM(dkdevid) != chksum) {
kmem_free((caddr_t)dkdevid, un->un_secsize);
return (EINVAL);
}
if (ddi_devid_valid((ddi_devid_t)&dkdevid->dkd_devid) != DDI_SUCCESS) {
kmem_free((caddr_t)dkdevid, un->un_secsize);
return (EINVAL);
}
sz = ddi_devid_sizeof((ddi_devid_t)&dkdevid->dkd_devid);
un->un_devid = (ddi_devid_t)kmem_alloc(sz, KM_SLEEP);
bcopy(&dkdevid->dkd_devid, un->un_devid, sz);
kmem_free((caddr_t)dkdevid, un->un_secsize);
return (0);
}
static ddi_devid_t
dcd_get_devid(struct dcd_disk *un)
{
int rc;
if (un->un_devid != NULL)
return (un->un_devid);
rc = dcd_make_devid_from_serial(un);
if (rc != DDI_SUCCESS) {
if (dcd_read_deviceid(un))
return (NULL);
}
(void) ddi_devid_register(DCD_DEVINFO, un->un_devid);
return (un->un_devid);
}
static ddi_devid_t
dcd_create_devid(struct dcd_disk *un)
{
if (ddi_devid_init(DCD_DEVINFO, DEVID_FAB, 0, NULL, (ddi_devid_t *)
&un->un_devid) == DDI_FAILURE)
return (NULL);
if (dcd_write_deviceid(un)) {
ddi_devid_free(un->un_devid);
un->un_devid = NULL;
return (NULL);
}
(void) ddi_devid_register(DCD_DEVINFO, un->un_devid);
return (un->un_devid);
}
static int
dcd_make_devid_from_serial(struct dcd_disk *un)
{
int rc = DDI_SUCCESS;
char *hwid;
char *model;
int model_len;
char *serno;
int serno_len;
int total_len;
model = un->un_dcd->dcd_ident->dcd_model;
model_len = DCD_MODEL_NUMBER_LENGTH;
serno = un->un_dcd->dcd_ident->dcd_drvser;
serno_len = DCD_SERIAL_NUMBER_LENGTH;
dcd_validate_model_serial(model, &model_len, model_len);
if (model_len == 0) {
rc = DDI_FAILURE;
goto out;
}
dcd_validate_model_serial(serno, &serno_len, serno_len);
if (serno_len == 0) {
rc = DDI_FAILURE;
goto out;
}
total_len = model_len + 1 + serno_len;
hwid = kmem_alloc(total_len, KM_SLEEP);
bcopy((caddr_t)model, (caddr_t)hwid, model_len);
bcopy((caddr_t)"=", (caddr_t)&hwid[model_len], 1);
bcopy((caddr_t)serno, (caddr_t)&hwid[model_len + 1], serno_len);
rc = ddi_devid_init(DCD_DEVINFO, DEVID_ATA_SERIAL, total_len,
hwid, (ddi_devid_t *)&un->un_devid);
kmem_free(hwid, total_len);
out: return (rc);
}
static void
dcd_validate_model_serial(char *str, int *retlen, int totallen)
{
char ch;
boolean_t ret = B_FALSE;
int i;
int tb;
for (i = 0, tb = 0; i < totallen; i++) {
ch = *str++;
if ((ch != ' ') && (ch != '\0') && (ch != '0'))
ret = B_TRUE;
if ((ch == ' ') || (ch == '\0'))
tb++;
else
tb = 0;
}
if (ret == B_TRUE) {
*retlen = totallen - tb;
} else {
*retlen = 0;
}
}
#ifndef lint
void
clean_print(dev_info_t *dev, char *label, uint_t level,
char *title, char *data, int len)
{
int i;
char buf[256];
(void) sprintf(buf, "%s:", title);
for (i = 0; i < len; i++) {
(void) sprintf(&buf[strlen(buf)], "0x%x ", (data[i] & 0xff));
}
(void) sprintf(&buf[strlen(buf)], "\n");
dcd_log(dev, label, level, "%s", buf);
}
#endif
#ifndef lint
void
inq_fill(char *p, int l, char *s)
{
unsigned i = 0;
char c;
while (i++ < l) {
if ((c = *p++) < ' ' || c >= 0177) {
c = '*';
} else if (i != 1 && c == ' ') {
break;
}
*s++ = c;
}
*s++ = 0;
}
#endif
char *
dcd_sname(uchar_t status)
{
switch (status & STATUS_ATA_MASK) {
case STATUS_GOOD:
return ("good status");
case STATUS_ATA_BUSY:
return ("busy");
default:
return ("<unknown status>");
}
}
char *
dcd_rname(int reason)
{
static char *rnames[] = {
"cmplt",
"incomplete",
"dma_derr",
"tran_err",
"reset",
"aborted",
"timeout",
"data_ovr",
};
if (reason > CMD_DATA_OVR) {
return ("<unknown reason>");
} else {
return (rnames[reason]);
}
}
int
dcd_check_wp(dev_t dev)
{
return (0);
}
static int
dcd_create_errstats(struct dcd_disk *un, int instance)
{
char kstatname[KSTAT_STRLEN];
if (un->un_errstats == (kstat_t *)0) {
(void) sprintf(kstatname, "dad%d,error", instance);
un->un_errstats = kstat_create("daderror", instance, kstatname,
"device_error", KSTAT_TYPE_NAMED,
sizeof (struct dcd_errstats)/ sizeof (kstat_named_t),
KSTAT_FLAG_PERSISTENT);
if (un->un_errstats) {
struct dcd_errstats *dtp;
dtp = (struct dcd_errstats *)un->un_errstats->ks_data;
kstat_named_init(&dtp->dcd_softerrs, "Soft Errors",
KSTAT_DATA_UINT32);
kstat_named_init(&dtp->dcd_harderrs, "Hard Errors",
KSTAT_DATA_UINT32);
kstat_named_init(&dtp->dcd_transerrs,
"Transport Errors", KSTAT_DATA_UINT32);
kstat_named_init(&dtp->dcd_model, "Model",
KSTAT_DATA_CHAR);
kstat_named_init(&dtp->dcd_revision, "Revision",
KSTAT_DATA_CHAR);
kstat_named_init(&dtp->dcd_serial, "Serial No",
KSTAT_DATA_CHAR);
kstat_named_init(&dtp->dcd_capacity, "Size",
KSTAT_DATA_ULONGLONG);
kstat_named_init(&dtp->dcd_rq_media_err, "Media Error",
KSTAT_DATA_UINT32);
kstat_named_init(&dtp->dcd_rq_ntrdy_err,
"Device Not Ready", KSTAT_DATA_UINT32);
kstat_named_init(&dtp->dcd_rq_nodev_err, " No Device",
KSTAT_DATA_UINT32);
kstat_named_init(&dtp->dcd_rq_recov_err, "Recoverable",
KSTAT_DATA_UINT32);
kstat_named_init(&dtp->dcd_rq_illrq_err,
"Illegal Request", KSTAT_DATA_UINT32);
un->un_errstats->ks_private = un;
un->un_errstats->ks_update = nulldev;
kstat_install(un->un_errstats);
(void) strncpy(&dtp->dcd_model.value.c[0],
un->un_dcd->dcd_ident->dcd_model, 16);
(void) strncpy(&dtp->dcd_serial.value.c[0],
un->un_dcd->dcd_ident->dcd_drvser, 16);
(void) strncpy(&dtp->dcd_revision.value.c[0],
un->un_dcd->dcd_ident->dcd_fw, 8);
dtp->dcd_capacity.value.ui64 =
(uint64_t)((uint64_t)un->un_diskcapacity *
(uint64_t)un->un_lbasize);
}
}
return (0);
}
int
dcd_poll(struct dcd_pkt *pkt)
{
int busy_count, rval = -1, savef;
clock_t savet;
void (*savec)();
savef = pkt->pkt_flags;
savec = pkt->pkt_comp;
savet = pkt->pkt_time;
pkt->pkt_flags |= FLAG_NOINTR;
pkt->pkt_comp = 0;
if (pkt->pkt_time == 0) {
pkt->pkt_time = DCD_POLL_TIMEOUT;
}
for (busy_count = 0; busy_count < dcd_poll_busycnt; busy_count++) {
if ((rval = dcd_transport(pkt)) == TRAN_ACCEPT) {
if (pkt->pkt_reason == CMD_INCOMPLETE &&
pkt->pkt_state == 0) {
delay(100);
} else if (pkt->pkt_reason == CMD_CMPLT) {
rval = 0;
break;
}
}
if (rval == TRAN_BUSY) {
delay(100);
continue;
}
}
pkt->pkt_flags = savef;
pkt->pkt_comp = savec;
pkt->pkt_time = savet;
return (rval);
}
void
dcd_translate(struct dadkio_status32 *statp, struct udcd_cmd *cmdp)
{
if (cmdp->udcd_status_reg & STATUS_ATA_BUSY)
statp->status = DADKIO_STAT_NOT_READY;
else if (cmdp->udcd_status_reg & STATUS_ATA_DWF)
statp->status = DADKIO_STAT_HARDWARE_ERROR;
else if (cmdp->udcd_status_reg & STATUS_ATA_CORR)
statp->status = DADKIO_STAT_SOFT_ERROR;
else if (cmdp->udcd_status_reg & STATUS_ATA_ERR) {
if (cmdp->udcd_error_reg & ERR_AMNF)
statp->status = DADKIO_STAT_NOT_FORMATTED;
else if (cmdp->udcd_error_reg & ERR_TKONF)
statp->status = DADKIO_STAT_NOT_FORMATTED;
else if (cmdp->udcd_error_reg & ERR_ABORT)
statp->status = DADKIO_STAT_ILLEGAL_REQUEST;
else if (cmdp->udcd_error_reg & ERR_IDNF)
statp->status = DADKIO_STAT_NOT_FORMATTED;
else if (cmdp->udcd_error_reg & ERR_UNC)
statp->status = DADKIO_STAT_BUS_ERROR;
else if (cmdp->udcd_error_reg & ERR_BBK)
statp->status = DADKIO_STAT_MEDIUM_ERROR;
} else
statp->status = DADKIO_STAT_NO_ERROR;
}
static void
dcd_flush_cache(struct dcd_disk *un)
{
struct dcd_pkt *pkt;
int retry_count;
if ((pkt = dcd_init_pkt(ROUTE, NULL, NULL,
(uint32_t)sizeof (struct dcd_cmd), 2, PP_LEN,
PKT_CONSISTENT, NULL_FUNC, NULL)) == NULL) {
return;
}
makecommand(pkt, 0, ATA_FLUSH_CACHE, 0, ADD_LBA_MODE, 0,
NO_DATA_XFER, 0);
for (retry_count = 0; retry_count < 3; retry_count++) {
pkt->pkt_comp = 0;
pkt->pkt_time = DCD_POLL_TIMEOUT;
pkt->pkt_flags |= FLAG_FORCENOINTR;
pkt->pkt_flags |= FLAG_NOINTR;
if (dcd_transport(pkt) == TRAN_ACCEPT) {
if (pkt->pkt_reason == CMD_CMPLT) {
break;
}
}
drv_usecwait(1000000);
}
(void) dcd_destroy_pkt(pkt);
}
static int
dcd_send_lb_rw_cmd(dev_info_t *devi, void *bufaddr,
diskaddr_t start_block, size_t reqlength, uchar_t cmd)
{
struct dcd_pkt *pkt;
struct buf *bp;
diskaddr_t real_addr = start_block;
size_t buffer_size = reqlength;
uchar_t command, tmp;
int i, rval = 0;
struct dcd_disk *un;
un = ddi_get_soft_state(dcd_state, ddi_get_instance(devi));
if (un == NULL)
return (ENXIO);
bp = dcd_alloc_consistent_buf(ROUTE, (struct buf *)NULL,
buffer_size, B_READ, NULL_FUNC, NULL);
if (!bp) {
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
"no bp for disk label\n");
return (ENOMEM);
}
pkt = dcd_init_pkt(ROUTE, (struct dcd_pkt *)NULL,
bp, (uint32_t)sizeof (struct dcd_cmd), 2, PP_LEN,
PKT_CONSISTENT, NULL_FUNC, NULL);
if (!pkt) {
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
"no memory for disk label\n");
dcd_free_consistent_buf(bp);
return (ENOMEM);
}
if (cmd == TG_READ) {
bzero(bp->b_un.b_addr, buffer_size);
tmp = DATA_READ;
} else {
bcopy((caddr_t)bufaddr, bp->b_un.b_addr, buffer_size);
tmp = DATA_WRITE;
}
mutex_enter(DCD_MUTEX);
if ((un->un_dp->options & DMA_SUPPORTTED) == DMA_SUPPORTTED) {
if (cmd == TG_READ) {
command = ATA_READ_DMA;
} else {
command = ATA_WRITE_DMA;
}
} else {
if (cmd == TG_READ) {
if (un->un_dp->options & BLOCK_MODE)
command = ATA_READ_MULTIPLE;
else
command = ATA_READ;
} else {
if (un->un_dp->options & BLOCK_MODE)
command = ATA_READ_MULTIPLE;
else
command = ATA_WRITE;
}
}
mutex_exit(DCD_MUTEX);
(void) makecommand(pkt, 0, command, real_addr, ADD_LBA_MODE,
buffer_size, tmp, 0);
for (i = 0; i < 3; i++) {
if (dcd_poll(pkt) || SCBP_C(pkt) != STATUS_GOOD ||
(pkt->pkt_state & STATE_XFERRED_DATA) == 0 ||
(pkt->pkt_resid != 0)) {
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"Status %x, state %x, resid %lx\n",
SCBP_C(pkt), pkt->pkt_state, pkt->pkt_resid);
rval = EIO;
} else {
break;
}
}
if (rval != 0) {
dcd_destroy_pkt(pkt);
dcd_free_consistent_buf(bp);
return (EIO);
}
if (cmd == TG_READ) {
bcopy(bp->b_un.b_addr, bufaddr, reqlength);
rval = 0;
}
dcd_destroy_pkt(pkt);
dcd_free_consistent_buf(bp);
return (rval);
}
static int dcd_compute_dk_capacity(struct dcd_device *devp,
diskaddr_t *capacity)
{
diskaddr_t cap;
diskaddr_t no_of_lbasec;
cap = devp->dcd_ident->dcd_fixcyls *
devp->dcd_ident->dcd_heads *
devp->dcd_ident->dcd_sectors;
no_of_lbasec = devp->dcd_ident->dcd_addrsec[1];
no_of_lbasec = no_of_lbasec << 16;
no_of_lbasec = no_of_lbasec | devp->dcd_ident->dcd_addrsec[0];
if (no_of_lbasec > cap) {
cap = no_of_lbasec;
}
if (cap != ((uint32_t)-1))
*capacity = cap;
else
return (EINVAL);
return (0);
}
static int
dcd_lb_rdwr(dev_info_t *devi, uchar_t cmd, void *bufaddr,
diskaddr_t start_block, size_t reqlength, void *tg_cookie)
{
if (cmd != TG_READ && cmd != TG_WRITE)
return (EINVAL);
return (dcd_send_lb_rw_cmd(devi, bufaddr, start_block,
reqlength, cmd));
}
static int
dcd_lb_getphygeom(dev_info_t *devi, cmlb_geom_t *phygeomp)
{
struct dcd_device *devp;
uint32_t no_of_lbasec, capacity, calculated_cylinders;
devp = ddi_get_driver_private(devi);
if ((devp->dcd_ident->dcd_config & ATAPI_DEVICE) == 0) {
if (devp->dcd_ident->dcd_config & ATANON_REMOVABLE) {
phygeomp->g_ncyl = devp->dcd_ident->dcd_fixcyls - 2;
phygeomp->g_acyl = 2;
phygeomp->g_nhead = devp->dcd_ident->dcd_heads;
phygeomp->g_nsect = devp->dcd_ident->dcd_sectors;
no_of_lbasec = devp->dcd_ident->dcd_addrsec[1];
no_of_lbasec = no_of_lbasec << 16;
no_of_lbasec = no_of_lbasec |
devp->dcd_ident->dcd_addrsec[0];
capacity = devp->dcd_ident->dcd_fixcyls *
devp->dcd_ident->dcd_heads *
devp->dcd_ident->dcd_sectors;
if (no_of_lbasec > capacity) {
capacity = no_of_lbasec;
if (capacity > NUM_SECTORS_32G) {
phygeomp->g_nsect = 255;
}
calculated_cylinders = (capacity) /
(phygeomp->g_nhead * phygeomp->g_nsect);
if (calculated_cylinders >= USHRT_MAX) {
phygeomp->g_ncyl = USHRT_MAX - 2;
} else {
phygeomp->g_ncyl =
calculated_cylinders - 2;
}
}
phygeomp->g_capacity = capacity;
phygeomp->g_intrlv = 0;
phygeomp->g_rpm = 5400;
phygeomp->g_secsize = devp->dcd_ident->dcd_secsiz;
return (0);
} else
return (ENOTSUP);
} else {
return (EINVAL);
}
}
static int
dcd_lb_getinfo(dev_info_t *devi, int cmd, void *arg, void *tg_cookie)
{
struct dcd_disk *un;
un = ddi_get_soft_state(dcd_state, ddi_get_instance(devi));
if (un == NULL)
return (ENXIO);
switch (cmd) {
case TG_GETPHYGEOM:
return (dcd_lb_getphygeom(devi, (cmlb_geom_t *)arg));
case TG_GETVIRTGEOM:
return (-1);
case TG_GETCAPACITY:
case TG_GETBLOCKSIZE:
mutex_enter(DCD_MUTEX);
if (un->un_diskcapacity <= 0) {
mutex_exit(DCD_MUTEX);
dcd_log(DCD_DEVINFO, dcd_label, CE_WARN,
"invalid disk capacity\n");
return (EIO);
}
if (cmd == TG_GETCAPACITY)
*(diskaddr_t *)arg = un->un_diskcapacity;
else
*(uint32_t *)arg = DEV_BSIZE;
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG, "capacity %x\n",
un->un_diskcapacity);
mutex_exit(DCD_MUTEX);
return (0);
case TG_GETATTR:
mutex_enter(DCD_MUTEX);
*(tg_attribute_t *)arg = un->un_tgattribute;
DAD_DEBUG2(DCD_DEVINFO, dcd_label, DCD_DEBUG,
"media_is_writable %x\n",
un->un_tgattribute.media_is_writable);
mutex_exit(DCD_MUTEX);
return (0);
default:
return (ENOTTY);
}
}