linux-imx

// SPDX-License-Identifier: GPL-2.0

#include <linux/kernel.h>

#include <linux/gfp.h>

#include <linux/ide.h>

#include <linux/jiffies.h>

#include <linux/blkdev.h>

​

DECLARE_WAIT_QUEUE_HEAD(ide_park_wq);

​

static void issue_park_cmd(ide_drive_t *drive, unsigned long timeout)

{

    ide_hwif_t *hwif = drive->hwif;

    struct request_queue *q = drive->queue;

    struct request *rq;

    int rc;

​

    timeout += jiffies;

    spin_lock_irq(&hwif->lock);

    if (drive->dev_flags & IDE_DFLAG_PARKED) {

        int reset_timer = time_before(timeout, drive->sleep);

        int start_queue = 0;

​

        drive->sleep = timeout;

        wake_up_all(&ide_park_wq);

        if (reset_timer && del_timer(&hwif->timer))

            start_queue = 1;

        spin_unlock_irq(&hwif->lock);

​

        if (start_queue)

            blk_mq_run_hw_queues(q, true);

        return;

    }

    spin_unlock_irq(&hwif->lock);

​

    rq = blk_get_request(q, REQ_OP_DRV_IN, 0);

    scsi_req(rq)->cmd[0] = REQ_PARK_HEADS;

    scsi_req(rq)->cmd_len = 1;

    ide_req(rq)->type = ATA_PRIV_MISC;

    ide_req(rq)->special = &timeout;

    blk_execute_rq(q, NULL, rq, 1);

    rc = scsi_req(rq)->result ? -EIO : 0;

    blk_put_request(rq);

    if (rc)

        goto out;

​

    /*

     * Make sure that *some* command is sent to the drive after the

     * timeout has expired, so power management will be reenabled.

     */

    rq = blk_get_request(q, REQ_OP_DRV_IN, BLK_MQ_REQ_NOWAIT);

    if (IS_ERR(rq))

        goto out;

​

    scsi_req(rq)->cmd[0] = REQ_UNPARK_HEADS;

    scsi_req(rq)->cmd_len = 1;

    ide_req(rq)->type = ATA_PRIV_MISC;

    spin_lock_irq(&hwif->lock);

    ide_insert_request_head(drive, rq);

    spin_unlock_irq(&hwif->lock);

​

out:

    return;

}