162306a36Sopenharmony_ci/*
262306a36Sopenharmony_ci *  linux/drivers/scsi/esas2r/esas2r_ioctl.c
362306a36Sopenharmony_ci *      For use with ATTO ExpressSAS R6xx SAS/SATA RAID controllers
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci *  Copyright (c) 2001-2013 ATTO Technology, Inc.
662306a36Sopenharmony_ci *  (mailto:linuxdrivers@attotech.com)
762306a36Sopenharmony_ci *
862306a36Sopenharmony_ci * This program is free software; you can redistribute it and/or
962306a36Sopenharmony_ci * modify it under the terms of the GNU General Public License
1062306a36Sopenharmony_ci * as published by the Free Software Foundation; either version 2
1162306a36Sopenharmony_ci * of the License, or (at your option) any later version.
1262306a36Sopenharmony_ci *
1362306a36Sopenharmony_ci * This program is distributed in the hope that it will be useful,
1462306a36Sopenharmony_ci * but WITHOUT ANY WARRANTY; without even the implied warranty of
1562306a36Sopenharmony_ci * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
1662306a36Sopenharmony_ci * GNU General Public License for more details.
1762306a36Sopenharmony_ci *
1862306a36Sopenharmony_ci * NO WARRANTY
1962306a36Sopenharmony_ci * THE PROGRAM IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR
2062306a36Sopenharmony_ci * CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED INCLUDING, WITHOUT
2162306a36Sopenharmony_ci * LIMITATION, ANY WARRANTIES OR CONDITIONS OF TITLE, NON-INFRINGEMENT,
2262306a36Sopenharmony_ci * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Each Recipient is
2362306a36Sopenharmony_ci * solely responsible for determining the appropriateness of using and
2462306a36Sopenharmony_ci * distributing the Program and assumes all risks associated with its
2562306a36Sopenharmony_ci * exercise of rights under this Agreement, including but not limited to
2662306a36Sopenharmony_ci * the risks and costs of program errors, damage to or loss of data,
2762306a36Sopenharmony_ci * programs or equipment, and unavailability or interruption of operations.
2862306a36Sopenharmony_ci *
2962306a36Sopenharmony_ci * DISCLAIMER OF LIABILITY
3062306a36Sopenharmony_ci * NEITHER RECIPIENT NOR ANY CONTRIBUTORS SHALL HAVE ANY LIABILITY FOR ANY
3162306a36Sopenharmony_ci * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
3262306a36Sopenharmony_ci * DAMAGES (INCLUDING WITHOUT LIMITATION LOST PROFITS), HOWEVER CAUSED AND
3362306a36Sopenharmony_ci * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
3462306a36Sopenharmony_ci * TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
3562306a36Sopenharmony_ci * USE OR DISTRIBUTION OF THE PROGRAM OR THE EXERCISE OF ANY RIGHTS GRANTED
3662306a36Sopenharmony_ci * HEREUNDER, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGES
3762306a36Sopenharmony_ci *
3862306a36Sopenharmony_ci * You should have received a copy of the GNU General Public License
3962306a36Sopenharmony_ci * along with this program; if not, write to the Free Software
4062306a36Sopenharmony_ci * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301,
4162306a36Sopenharmony_ci * USA.
4262306a36Sopenharmony_ci */
4362306a36Sopenharmony_ci
4462306a36Sopenharmony_ci#include "esas2r.h"
4562306a36Sopenharmony_ci
4662306a36Sopenharmony_ci/*
4762306a36Sopenharmony_ci * Buffered ioctl handlers.  A buffered ioctl is one which requires that we
4862306a36Sopenharmony_ci * allocate a DMA-able memory area to communicate with the firmware.  In
4962306a36Sopenharmony_ci * order to prevent continually allocating and freeing consistent memory,
5062306a36Sopenharmony_ci * we will allocate a global buffer the first time we need it and re-use
5162306a36Sopenharmony_ci * it for subsequent ioctl calls that require it.
5262306a36Sopenharmony_ci */
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_ciu8 *esas2r_buffered_ioctl;
5562306a36Sopenharmony_cidma_addr_t esas2r_buffered_ioctl_addr;
5662306a36Sopenharmony_ciu32 esas2r_buffered_ioctl_size;
5762306a36Sopenharmony_cistruct pci_dev *esas2r_buffered_ioctl_pcid;
5862306a36Sopenharmony_ci
5962306a36Sopenharmony_cistatic DEFINE_SEMAPHORE(buffered_ioctl_semaphore, 1);
6062306a36Sopenharmony_citypedef int (*BUFFERED_IOCTL_CALLBACK)(struct esas2r_adapter *,
6162306a36Sopenharmony_ci				       struct esas2r_request *,
6262306a36Sopenharmony_ci				       struct esas2r_sg_context *,
6362306a36Sopenharmony_ci				       void *);
6462306a36Sopenharmony_citypedef void (*BUFFERED_IOCTL_DONE_CALLBACK)(struct esas2r_adapter *,
6562306a36Sopenharmony_ci					     struct esas2r_request *, void *);
6662306a36Sopenharmony_ci
6762306a36Sopenharmony_cistruct esas2r_buffered_ioctl {
6862306a36Sopenharmony_ci	struct esas2r_adapter *a;
6962306a36Sopenharmony_ci	void *ioctl;
7062306a36Sopenharmony_ci	u32 length;
7162306a36Sopenharmony_ci	u32 control_code;
7262306a36Sopenharmony_ci	u32 offset;
7362306a36Sopenharmony_ci	BUFFERED_IOCTL_CALLBACK
7462306a36Sopenharmony_ci		callback;
7562306a36Sopenharmony_ci	void *context;
7662306a36Sopenharmony_ci	BUFFERED_IOCTL_DONE_CALLBACK
7762306a36Sopenharmony_ci		done_callback;
7862306a36Sopenharmony_ci	void *done_context;
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_ci};
8162306a36Sopenharmony_ci
8262306a36Sopenharmony_cistatic void complete_fm_api_req(struct esas2r_adapter *a,
8362306a36Sopenharmony_ci				struct esas2r_request *rq)
8462306a36Sopenharmony_ci{
8562306a36Sopenharmony_ci	a->fm_api_command_done = 1;
8662306a36Sopenharmony_ci	wake_up_interruptible(&a->fm_api_waiter);
8762306a36Sopenharmony_ci}
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_ci/* Callbacks for building scatter/gather lists for FM API requests */
9062306a36Sopenharmony_cistatic u32 get_physaddr_fm_api(struct esas2r_sg_context *sgc, u64 *addr)
9162306a36Sopenharmony_ci{
9262306a36Sopenharmony_ci	struct esas2r_adapter *a = (struct esas2r_adapter *)sgc->adapter;
9362306a36Sopenharmony_ci	int offset = sgc->cur_offset - a->save_offset;
9462306a36Sopenharmony_ci
9562306a36Sopenharmony_ci	(*addr) = a->firmware.phys + offset;
9662306a36Sopenharmony_ci	return a->firmware.orig_len - offset;
9762306a36Sopenharmony_ci}
9862306a36Sopenharmony_ci
9962306a36Sopenharmony_cistatic u32 get_physaddr_fm_api_header(struct esas2r_sg_context *sgc, u64 *addr)
10062306a36Sopenharmony_ci{
10162306a36Sopenharmony_ci	struct esas2r_adapter *a = (struct esas2r_adapter *)sgc->adapter;
10262306a36Sopenharmony_ci	int offset = sgc->cur_offset - a->save_offset;
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_ci	(*addr) = a->firmware.header_buff_phys + offset;
10562306a36Sopenharmony_ci	return sizeof(struct esas2r_flash_img) - offset;
10662306a36Sopenharmony_ci}
10762306a36Sopenharmony_ci
10862306a36Sopenharmony_ci/* Handle EXPRESS_IOCTL_RW_FIRMWARE ioctl with img_type = FW_IMG_FM_API. */
10962306a36Sopenharmony_cistatic void do_fm_api(struct esas2r_adapter *a, struct esas2r_flash_img *fi)
11062306a36Sopenharmony_ci{
11162306a36Sopenharmony_ci	struct esas2r_request *rq;
11262306a36Sopenharmony_ci
11362306a36Sopenharmony_ci	if (mutex_lock_interruptible(&a->fm_api_mutex)) {
11462306a36Sopenharmony_ci		fi->status = FI_STAT_BUSY;
11562306a36Sopenharmony_ci		return;
11662306a36Sopenharmony_ci	}
11762306a36Sopenharmony_ci
11862306a36Sopenharmony_ci	rq = esas2r_alloc_request(a);
11962306a36Sopenharmony_ci	if (rq == NULL) {
12062306a36Sopenharmony_ci		fi->status = FI_STAT_BUSY;
12162306a36Sopenharmony_ci		goto free_sem;
12262306a36Sopenharmony_ci	}
12362306a36Sopenharmony_ci
12462306a36Sopenharmony_ci	if (fi == &a->firmware.header) {
12562306a36Sopenharmony_ci		a->firmware.header_buff = dma_alloc_coherent(&a->pcid->dev,
12662306a36Sopenharmony_ci							     (size_t)sizeof(
12762306a36Sopenharmony_ci								     struct
12862306a36Sopenharmony_ci								     esas2r_flash_img),
12962306a36Sopenharmony_ci							     (dma_addr_t *)&a->
13062306a36Sopenharmony_ci							     firmware.
13162306a36Sopenharmony_ci							     header_buff_phys,
13262306a36Sopenharmony_ci							     GFP_KERNEL);
13362306a36Sopenharmony_ci
13462306a36Sopenharmony_ci		if (a->firmware.header_buff == NULL) {
13562306a36Sopenharmony_ci			esas2r_debug("failed to allocate header buffer!");
13662306a36Sopenharmony_ci			fi->status = FI_STAT_BUSY;
13762306a36Sopenharmony_ci			goto free_req;
13862306a36Sopenharmony_ci		}
13962306a36Sopenharmony_ci
14062306a36Sopenharmony_ci		memcpy(a->firmware.header_buff, fi,
14162306a36Sopenharmony_ci		       sizeof(struct esas2r_flash_img));
14262306a36Sopenharmony_ci		a->save_offset = a->firmware.header_buff;
14362306a36Sopenharmony_ci		a->fm_api_sgc.get_phys_addr =
14462306a36Sopenharmony_ci			(PGETPHYSADDR)get_physaddr_fm_api_header;
14562306a36Sopenharmony_ci	} else {
14662306a36Sopenharmony_ci		a->save_offset = (u8 *)fi;
14762306a36Sopenharmony_ci		a->fm_api_sgc.get_phys_addr =
14862306a36Sopenharmony_ci			(PGETPHYSADDR)get_physaddr_fm_api;
14962306a36Sopenharmony_ci	}
15062306a36Sopenharmony_ci
15162306a36Sopenharmony_ci	rq->comp_cb = complete_fm_api_req;
15262306a36Sopenharmony_ci	a->fm_api_command_done = 0;
15362306a36Sopenharmony_ci	a->fm_api_sgc.cur_offset = a->save_offset;
15462306a36Sopenharmony_ci
15562306a36Sopenharmony_ci	if (!esas2r_fm_api(a, (struct esas2r_flash_img *)a->save_offset, rq,
15662306a36Sopenharmony_ci			   &a->fm_api_sgc))
15762306a36Sopenharmony_ci		goto all_done;
15862306a36Sopenharmony_ci
15962306a36Sopenharmony_ci	/* Now wait around for it to complete. */
16062306a36Sopenharmony_ci	while (!a->fm_api_command_done)
16162306a36Sopenharmony_ci		wait_event_interruptible(a->fm_api_waiter,
16262306a36Sopenharmony_ci					 a->fm_api_command_done);
16362306a36Sopenharmony_ciall_done:
16462306a36Sopenharmony_ci	if (fi == &a->firmware.header) {
16562306a36Sopenharmony_ci		memcpy(fi, a->firmware.header_buff,
16662306a36Sopenharmony_ci		       sizeof(struct esas2r_flash_img));
16762306a36Sopenharmony_ci
16862306a36Sopenharmony_ci		dma_free_coherent(&a->pcid->dev,
16962306a36Sopenharmony_ci				  (size_t)sizeof(struct esas2r_flash_img),
17062306a36Sopenharmony_ci				  a->firmware.header_buff,
17162306a36Sopenharmony_ci				  (dma_addr_t)a->firmware.header_buff_phys);
17262306a36Sopenharmony_ci	}
17362306a36Sopenharmony_cifree_req:
17462306a36Sopenharmony_ci	esas2r_free_request(a, (struct esas2r_request *)rq);
17562306a36Sopenharmony_cifree_sem:
17662306a36Sopenharmony_ci	mutex_unlock(&a->fm_api_mutex);
17762306a36Sopenharmony_ci	return;
17862306a36Sopenharmony_ci
17962306a36Sopenharmony_ci}
18062306a36Sopenharmony_ci
18162306a36Sopenharmony_cistatic void complete_nvr_req(struct esas2r_adapter *a,
18262306a36Sopenharmony_ci			     struct esas2r_request *rq)
18362306a36Sopenharmony_ci{
18462306a36Sopenharmony_ci	a->nvram_command_done = 1;
18562306a36Sopenharmony_ci	wake_up_interruptible(&a->nvram_waiter);
18662306a36Sopenharmony_ci}
18762306a36Sopenharmony_ci
18862306a36Sopenharmony_ci/* Callback for building scatter/gather lists for buffered ioctls */
18962306a36Sopenharmony_cistatic u32 get_physaddr_buffered_ioctl(struct esas2r_sg_context *sgc,
19062306a36Sopenharmony_ci				       u64 *addr)
19162306a36Sopenharmony_ci{
19262306a36Sopenharmony_ci	int offset = (u8 *)sgc->cur_offset - esas2r_buffered_ioctl;
19362306a36Sopenharmony_ci
19462306a36Sopenharmony_ci	(*addr) = esas2r_buffered_ioctl_addr + offset;
19562306a36Sopenharmony_ci	return esas2r_buffered_ioctl_size - offset;
19662306a36Sopenharmony_ci}
19762306a36Sopenharmony_ci
19862306a36Sopenharmony_cistatic void complete_buffered_ioctl_req(struct esas2r_adapter *a,
19962306a36Sopenharmony_ci					struct esas2r_request *rq)
20062306a36Sopenharmony_ci{
20162306a36Sopenharmony_ci	a->buffered_ioctl_done = 1;
20262306a36Sopenharmony_ci	wake_up_interruptible(&a->buffered_ioctl_waiter);
20362306a36Sopenharmony_ci}
20462306a36Sopenharmony_ci
20562306a36Sopenharmony_cistatic u8 handle_buffered_ioctl(struct esas2r_buffered_ioctl *bi)
20662306a36Sopenharmony_ci{
20762306a36Sopenharmony_ci	struct esas2r_adapter *a = bi->a;
20862306a36Sopenharmony_ci	struct esas2r_request *rq;
20962306a36Sopenharmony_ci	struct esas2r_sg_context sgc;
21062306a36Sopenharmony_ci	u8 result = IOCTL_SUCCESS;
21162306a36Sopenharmony_ci
21262306a36Sopenharmony_ci	if (down_interruptible(&buffered_ioctl_semaphore))
21362306a36Sopenharmony_ci		return IOCTL_OUT_OF_RESOURCES;
21462306a36Sopenharmony_ci
21562306a36Sopenharmony_ci	/* allocate a buffer or use the existing buffer. */
21662306a36Sopenharmony_ci	if (esas2r_buffered_ioctl) {
21762306a36Sopenharmony_ci		if (esas2r_buffered_ioctl_size < bi->length) {
21862306a36Sopenharmony_ci			/* free the too-small buffer and get a new one */
21962306a36Sopenharmony_ci			dma_free_coherent(&a->pcid->dev,
22062306a36Sopenharmony_ci					  (size_t)esas2r_buffered_ioctl_size,
22162306a36Sopenharmony_ci					  esas2r_buffered_ioctl,
22262306a36Sopenharmony_ci					  esas2r_buffered_ioctl_addr);
22362306a36Sopenharmony_ci
22462306a36Sopenharmony_ci			goto allocate_buffer;
22562306a36Sopenharmony_ci		}
22662306a36Sopenharmony_ci	} else {
22762306a36Sopenharmony_ciallocate_buffer:
22862306a36Sopenharmony_ci		esas2r_buffered_ioctl_size = bi->length;
22962306a36Sopenharmony_ci		esas2r_buffered_ioctl_pcid = a->pcid;
23062306a36Sopenharmony_ci		esas2r_buffered_ioctl = dma_alloc_coherent(&a->pcid->dev,
23162306a36Sopenharmony_ci							   (size_t)
23262306a36Sopenharmony_ci							   esas2r_buffered_ioctl_size,
23362306a36Sopenharmony_ci							   &
23462306a36Sopenharmony_ci							   esas2r_buffered_ioctl_addr,
23562306a36Sopenharmony_ci							   GFP_KERNEL);
23662306a36Sopenharmony_ci	}
23762306a36Sopenharmony_ci
23862306a36Sopenharmony_ci	if (!esas2r_buffered_ioctl) {
23962306a36Sopenharmony_ci		esas2r_log(ESAS2R_LOG_CRIT,
24062306a36Sopenharmony_ci			   "could not allocate %d bytes of consistent memory "
24162306a36Sopenharmony_ci			   "for a buffered ioctl!",
24262306a36Sopenharmony_ci			   bi->length);
24362306a36Sopenharmony_ci
24462306a36Sopenharmony_ci		esas2r_debug("buffered ioctl alloc failure");
24562306a36Sopenharmony_ci		result = IOCTL_OUT_OF_RESOURCES;
24662306a36Sopenharmony_ci		goto exit_cleanly;
24762306a36Sopenharmony_ci	}
24862306a36Sopenharmony_ci
24962306a36Sopenharmony_ci	memcpy(esas2r_buffered_ioctl, bi->ioctl, bi->length);
25062306a36Sopenharmony_ci
25162306a36Sopenharmony_ci	rq = esas2r_alloc_request(a);
25262306a36Sopenharmony_ci	if (rq == NULL) {
25362306a36Sopenharmony_ci		esas2r_log(ESAS2R_LOG_CRIT,
25462306a36Sopenharmony_ci			   "could not allocate an internal request");
25562306a36Sopenharmony_ci
25662306a36Sopenharmony_ci		result = IOCTL_OUT_OF_RESOURCES;
25762306a36Sopenharmony_ci		esas2r_debug("buffered ioctl - no requests");
25862306a36Sopenharmony_ci		goto exit_cleanly;
25962306a36Sopenharmony_ci	}
26062306a36Sopenharmony_ci
26162306a36Sopenharmony_ci	a->buffered_ioctl_done = 0;
26262306a36Sopenharmony_ci	rq->comp_cb = complete_buffered_ioctl_req;
26362306a36Sopenharmony_ci	sgc.cur_offset = esas2r_buffered_ioctl + bi->offset;
26462306a36Sopenharmony_ci	sgc.get_phys_addr = (PGETPHYSADDR)get_physaddr_buffered_ioctl;
26562306a36Sopenharmony_ci	sgc.length = esas2r_buffered_ioctl_size;
26662306a36Sopenharmony_ci
26762306a36Sopenharmony_ci	if (!(*bi->callback)(a, rq, &sgc, bi->context)) {
26862306a36Sopenharmony_ci		/* completed immediately, no need to wait */
26962306a36Sopenharmony_ci		a->buffered_ioctl_done = 0;
27062306a36Sopenharmony_ci		goto free_andexit_cleanly;
27162306a36Sopenharmony_ci	}
27262306a36Sopenharmony_ci
27362306a36Sopenharmony_ci	/* now wait around for it to complete. */
27462306a36Sopenharmony_ci	while (!a->buffered_ioctl_done)
27562306a36Sopenharmony_ci		wait_event_interruptible(a->buffered_ioctl_waiter,
27662306a36Sopenharmony_ci					 a->buffered_ioctl_done);
27762306a36Sopenharmony_ci
27862306a36Sopenharmony_cifree_andexit_cleanly:
27962306a36Sopenharmony_ci	if (result == IOCTL_SUCCESS && bi->done_callback)
28062306a36Sopenharmony_ci		(*bi->done_callback)(a, rq, bi->done_context);
28162306a36Sopenharmony_ci
28262306a36Sopenharmony_ci	esas2r_free_request(a, rq);
28362306a36Sopenharmony_ci
28462306a36Sopenharmony_ciexit_cleanly:
28562306a36Sopenharmony_ci	if (result == IOCTL_SUCCESS)
28662306a36Sopenharmony_ci		memcpy(bi->ioctl, esas2r_buffered_ioctl, bi->length);
28762306a36Sopenharmony_ci
28862306a36Sopenharmony_ci	up(&buffered_ioctl_semaphore);
28962306a36Sopenharmony_ci	return result;
29062306a36Sopenharmony_ci}
29162306a36Sopenharmony_ci
29262306a36Sopenharmony_ci/* SMP ioctl support */
29362306a36Sopenharmony_cistatic int smp_ioctl_callback(struct esas2r_adapter *a,
29462306a36Sopenharmony_ci			      struct esas2r_request *rq,
29562306a36Sopenharmony_ci			      struct esas2r_sg_context *sgc, void *context)
29662306a36Sopenharmony_ci{
29762306a36Sopenharmony_ci	struct atto_ioctl_smp *si =
29862306a36Sopenharmony_ci		(struct atto_ioctl_smp *)esas2r_buffered_ioctl;
29962306a36Sopenharmony_ci
30062306a36Sopenharmony_ci	esas2r_sgc_init(sgc, a, rq, rq->vrq->ioctl.sge);
30162306a36Sopenharmony_ci	esas2r_build_ioctl_req(a, rq, sgc->length, VDA_IOCTL_SMP);
30262306a36Sopenharmony_ci
30362306a36Sopenharmony_ci	if (!esas2r_build_sg_list(a, rq, sgc)) {
30462306a36Sopenharmony_ci		si->status = ATTO_STS_OUT_OF_RSRC;
30562306a36Sopenharmony_ci		return false;
30662306a36Sopenharmony_ci	}
30762306a36Sopenharmony_ci
30862306a36Sopenharmony_ci	esas2r_start_request(a, rq);
30962306a36Sopenharmony_ci	return true;
31062306a36Sopenharmony_ci}
31162306a36Sopenharmony_ci
31262306a36Sopenharmony_cistatic u8 handle_smp_ioctl(struct esas2r_adapter *a, struct atto_ioctl_smp *si)
31362306a36Sopenharmony_ci{
31462306a36Sopenharmony_ci	struct esas2r_buffered_ioctl bi;
31562306a36Sopenharmony_ci
31662306a36Sopenharmony_ci	memset(&bi, 0, sizeof(bi));
31762306a36Sopenharmony_ci
31862306a36Sopenharmony_ci	bi.a = a;
31962306a36Sopenharmony_ci	bi.ioctl = si;
32062306a36Sopenharmony_ci	bi.length = sizeof(struct atto_ioctl_smp)
32162306a36Sopenharmony_ci		    + le32_to_cpu(si->req_length)
32262306a36Sopenharmony_ci		    + le32_to_cpu(si->rsp_length);
32362306a36Sopenharmony_ci	bi.offset = 0;
32462306a36Sopenharmony_ci	bi.callback = smp_ioctl_callback;
32562306a36Sopenharmony_ci	return handle_buffered_ioctl(&bi);
32662306a36Sopenharmony_ci}
32762306a36Sopenharmony_ci
32862306a36Sopenharmony_ci
32962306a36Sopenharmony_ci/* CSMI ioctl support */
33062306a36Sopenharmony_cistatic void esas2r_csmi_ioctl_tunnel_comp_cb(struct esas2r_adapter *a,
33162306a36Sopenharmony_ci					     struct esas2r_request *rq)
33262306a36Sopenharmony_ci{
33362306a36Sopenharmony_ci	rq->target_id = le16_to_cpu(rq->func_rsp.ioctl_rsp.csmi.target_id);
33462306a36Sopenharmony_ci	rq->vrq->scsi.flags |= cpu_to_le32(rq->func_rsp.ioctl_rsp.csmi.lun);
33562306a36Sopenharmony_ci
33662306a36Sopenharmony_ci	/* Now call the original completion callback. */
33762306a36Sopenharmony_ci	(*rq->aux_req_cb)(a, rq);
33862306a36Sopenharmony_ci}
33962306a36Sopenharmony_ci
34062306a36Sopenharmony_ci/* Tunnel a CSMI IOCTL to the back end driver for processing. */
34162306a36Sopenharmony_cistatic bool csmi_ioctl_tunnel(struct esas2r_adapter *a,
34262306a36Sopenharmony_ci			      union atto_ioctl_csmi *ci,
34362306a36Sopenharmony_ci			      struct esas2r_request *rq,
34462306a36Sopenharmony_ci			      struct esas2r_sg_context *sgc,
34562306a36Sopenharmony_ci			      u32 ctrl_code,
34662306a36Sopenharmony_ci			      u16 target_id)
34762306a36Sopenharmony_ci{
34862306a36Sopenharmony_ci	struct atto_vda_ioctl_req *ioctl = &rq->vrq->ioctl;
34962306a36Sopenharmony_ci
35062306a36Sopenharmony_ci	if (test_bit(AF_DEGRADED_MODE, &a->flags))
35162306a36Sopenharmony_ci		return false;
35262306a36Sopenharmony_ci
35362306a36Sopenharmony_ci	esas2r_sgc_init(sgc, a, rq, rq->vrq->ioctl.sge);
35462306a36Sopenharmony_ci	esas2r_build_ioctl_req(a, rq, sgc->length, VDA_IOCTL_CSMI);
35562306a36Sopenharmony_ci	ioctl->csmi.ctrl_code = cpu_to_le32(ctrl_code);
35662306a36Sopenharmony_ci	ioctl->csmi.target_id = cpu_to_le16(target_id);
35762306a36Sopenharmony_ci	ioctl->csmi.lun = (u8)le32_to_cpu(rq->vrq->scsi.flags);
35862306a36Sopenharmony_ci
35962306a36Sopenharmony_ci	/*
36062306a36Sopenharmony_ci	 * Always usurp the completion callback since the interrupt callback
36162306a36Sopenharmony_ci	 * mechanism may be used.
36262306a36Sopenharmony_ci	 */
36362306a36Sopenharmony_ci	rq->aux_req_cx = ci;
36462306a36Sopenharmony_ci	rq->aux_req_cb = rq->comp_cb;
36562306a36Sopenharmony_ci	rq->comp_cb = esas2r_csmi_ioctl_tunnel_comp_cb;
36662306a36Sopenharmony_ci
36762306a36Sopenharmony_ci	if (!esas2r_build_sg_list(a, rq, sgc))
36862306a36Sopenharmony_ci		return false;
36962306a36Sopenharmony_ci
37062306a36Sopenharmony_ci	esas2r_start_request(a, rq);
37162306a36Sopenharmony_ci	return true;
37262306a36Sopenharmony_ci}
37362306a36Sopenharmony_ci
37462306a36Sopenharmony_cistatic bool check_lun(struct scsi_lun lun)
37562306a36Sopenharmony_ci{
37662306a36Sopenharmony_ci	bool result;
37762306a36Sopenharmony_ci
37862306a36Sopenharmony_ci	result = ((lun.scsi_lun[7] == 0) &&
37962306a36Sopenharmony_ci		  (lun.scsi_lun[6] == 0) &&
38062306a36Sopenharmony_ci		  (lun.scsi_lun[5] == 0) &&
38162306a36Sopenharmony_ci		  (lun.scsi_lun[4] == 0) &&
38262306a36Sopenharmony_ci		  (lun.scsi_lun[3] == 0) &&
38362306a36Sopenharmony_ci		  (lun.scsi_lun[2] == 0) &&
38462306a36Sopenharmony_ci/* Byte 1 is intentionally skipped */
38562306a36Sopenharmony_ci		  (lun.scsi_lun[0] == 0));
38662306a36Sopenharmony_ci
38762306a36Sopenharmony_ci	return result;
38862306a36Sopenharmony_ci}
38962306a36Sopenharmony_ci
39062306a36Sopenharmony_cistatic int csmi_ioctl_callback(struct esas2r_adapter *a,
39162306a36Sopenharmony_ci			       struct esas2r_request *rq,
39262306a36Sopenharmony_ci			       struct esas2r_sg_context *sgc, void *context)
39362306a36Sopenharmony_ci{
39462306a36Sopenharmony_ci	struct atto_csmi *ci = (struct atto_csmi *)context;
39562306a36Sopenharmony_ci	union atto_ioctl_csmi *ioctl_csmi =
39662306a36Sopenharmony_ci		(union atto_ioctl_csmi *)esas2r_buffered_ioctl;
39762306a36Sopenharmony_ci	u8 path = 0;
39862306a36Sopenharmony_ci	u8 tid = 0;
39962306a36Sopenharmony_ci	u8 lun = 0;
40062306a36Sopenharmony_ci	u32 sts = CSMI_STS_SUCCESS;
40162306a36Sopenharmony_ci	struct esas2r_target *t;
40262306a36Sopenharmony_ci	unsigned long flags;
40362306a36Sopenharmony_ci
40462306a36Sopenharmony_ci	if (ci->control_code == CSMI_CC_GET_DEV_ADDR) {
40562306a36Sopenharmony_ci		struct atto_csmi_get_dev_addr *gda = &ci->data.dev_addr;
40662306a36Sopenharmony_ci
40762306a36Sopenharmony_ci		path = gda->path_id;
40862306a36Sopenharmony_ci		tid = gda->target_id;
40962306a36Sopenharmony_ci		lun = gda->lun;
41062306a36Sopenharmony_ci	} else if (ci->control_code == CSMI_CC_TASK_MGT) {
41162306a36Sopenharmony_ci		struct atto_csmi_task_mgmt *tm = &ci->data.tsk_mgt;
41262306a36Sopenharmony_ci
41362306a36Sopenharmony_ci		path = tm->path_id;
41462306a36Sopenharmony_ci		tid = tm->target_id;
41562306a36Sopenharmony_ci		lun = tm->lun;
41662306a36Sopenharmony_ci	}
41762306a36Sopenharmony_ci
41862306a36Sopenharmony_ci	if (path > 0) {
41962306a36Sopenharmony_ci		rq->func_rsp.ioctl_rsp.csmi.csmi_status = cpu_to_le32(
42062306a36Sopenharmony_ci			CSMI_STS_INV_PARAM);
42162306a36Sopenharmony_ci		return false;
42262306a36Sopenharmony_ci	}
42362306a36Sopenharmony_ci
42462306a36Sopenharmony_ci	rq->target_id = tid;
42562306a36Sopenharmony_ci	rq->vrq->scsi.flags |= cpu_to_le32(lun);
42662306a36Sopenharmony_ci
42762306a36Sopenharmony_ci	switch (ci->control_code) {
42862306a36Sopenharmony_ci	case CSMI_CC_GET_DRVR_INFO:
42962306a36Sopenharmony_ci	{
43062306a36Sopenharmony_ci		struct atto_csmi_get_driver_info *gdi = &ioctl_csmi->drvr_info;
43162306a36Sopenharmony_ci
43262306a36Sopenharmony_ci		strcpy(gdi->description, esas2r_get_model_name(a));
43362306a36Sopenharmony_ci		gdi->csmi_major_rev = CSMI_MAJOR_REV;
43462306a36Sopenharmony_ci		gdi->csmi_minor_rev = CSMI_MINOR_REV;
43562306a36Sopenharmony_ci		break;
43662306a36Sopenharmony_ci	}
43762306a36Sopenharmony_ci
43862306a36Sopenharmony_ci	case CSMI_CC_GET_CNTLR_CFG:
43962306a36Sopenharmony_ci	{
44062306a36Sopenharmony_ci		struct atto_csmi_get_cntlr_cfg *gcc = &ioctl_csmi->cntlr_cfg;
44162306a36Sopenharmony_ci
44262306a36Sopenharmony_ci		gcc->base_io_addr = 0;
44362306a36Sopenharmony_ci		pci_read_config_dword(a->pcid, PCI_BASE_ADDRESS_2,
44462306a36Sopenharmony_ci				      &gcc->base_memaddr_lo);
44562306a36Sopenharmony_ci		pci_read_config_dword(a->pcid, PCI_BASE_ADDRESS_3,
44662306a36Sopenharmony_ci				      &gcc->base_memaddr_hi);
44762306a36Sopenharmony_ci		gcc->board_id = MAKEDWORD(a->pcid->subsystem_device,
44862306a36Sopenharmony_ci					  a->pcid->subsystem_vendor);
44962306a36Sopenharmony_ci		gcc->slot_num = CSMI_SLOT_NUM_UNKNOWN;
45062306a36Sopenharmony_ci		gcc->cntlr_class = CSMI_CNTLR_CLASS_HBA;
45162306a36Sopenharmony_ci		gcc->io_bus_type = CSMI_BUS_TYPE_PCI;
45262306a36Sopenharmony_ci		gcc->pci_addr.bus_num = a->pcid->bus->number;
45362306a36Sopenharmony_ci		gcc->pci_addr.device_num = PCI_SLOT(a->pcid->devfn);
45462306a36Sopenharmony_ci		gcc->pci_addr.function_num = PCI_FUNC(a->pcid->devfn);
45562306a36Sopenharmony_ci
45662306a36Sopenharmony_ci		memset(gcc->serial_num, 0, sizeof(gcc->serial_num));
45762306a36Sopenharmony_ci
45862306a36Sopenharmony_ci		gcc->major_rev = LOBYTE(LOWORD(a->fw_version));
45962306a36Sopenharmony_ci		gcc->minor_rev = HIBYTE(LOWORD(a->fw_version));
46062306a36Sopenharmony_ci		gcc->build_rev = LOBYTE(HIWORD(a->fw_version));
46162306a36Sopenharmony_ci		gcc->release_rev = HIBYTE(HIWORD(a->fw_version));
46262306a36Sopenharmony_ci		gcc->bios_major_rev = HIBYTE(HIWORD(a->flash_ver));
46362306a36Sopenharmony_ci		gcc->bios_minor_rev = LOBYTE(HIWORD(a->flash_ver));
46462306a36Sopenharmony_ci		gcc->bios_build_rev = LOWORD(a->flash_ver);
46562306a36Sopenharmony_ci
46662306a36Sopenharmony_ci		if (test_bit(AF2_THUNDERLINK, &a->flags2))
46762306a36Sopenharmony_ci			gcc->cntlr_flags = CSMI_CNTLRF_SAS_HBA
46862306a36Sopenharmony_ci					   | CSMI_CNTLRF_SATA_HBA;
46962306a36Sopenharmony_ci		else
47062306a36Sopenharmony_ci			gcc->cntlr_flags = CSMI_CNTLRF_SAS_RAID
47162306a36Sopenharmony_ci					   | CSMI_CNTLRF_SATA_RAID;
47262306a36Sopenharmony_ci
47362306a36Sopenharmony_ci		gcc->rrom_major_rev = 0;
47462306a36Sopenharmony_ci		gcc->rrom_minor_rev = 0;
47562306a36Sopenharmony_ci		gcc->rrom_build_rev = 0;
47662306a36Sopenharmony_ci		gcc->rrom_release_rev = 0;
47762306a36Sopenharmony_ci		gcc->rrom_biosmajor_rev = 0;
47862306a36Sopenharmony_ci		gcc->rrom_biosminor_rev = 0;
47962306a36Sopenharmony_ci		gcc->rrom_biosbuild_rev = 0;
48062306a36Sopenharmony_ci		gcc->rrom_biosrelease_rev = 0;
48162306a36Sopenharmony_ci		break;
48262306a36Sopenharmony_ci	}
48362306a36Sopenharmony_ci
48462306a36Sopenharmony_ci	case CSMI_CC_GET_CNTLR_STS:
48562306a36Sopenharmony_ci	{
48662306a36Sopenharmony_ci		struct atto_csmi_get_cntlr_sts *gcs = &ioctl_csmi->cntlr_sts;
48762306a36Sopenharmony_ci
48862306a36Sopenharmony_ci		if (test_bit(AF_DEGRADED_MODE, &a->flags))
48962306a36Sopenharmony_ci			gcs->status = CSMI_CNTLR_STS_FAILED;
49062306a36Sopenharmony_ci		else
49162306a36Sopenharmony_ci			gcs->status = CSMI_CNTLR_STS_GOOD;
49262306a36Sopenharmony_ci
49362306a36Sopenharmony_ci		gcs->offline_reason = CSMI_OFFLINE_NO_REASON;
49462306a36Sopenharmony_ci		break;
49562306a36Sopenharmony_ci	}
49662306a36Sopenharmony_ci
49762306a36Sopenharmony_ci	case CSMI_CC_FW_DOWNLOAD:
49862306a36Sopenharmony_ci	case CSMI_CC_GET_RAID_INFO:
49962306a36Sopenharmony_ci	case CSMI_CC_GET_RAID_CFG:
50062306a36Sopenharmony_ci
50162306a36Sopenharmony_ci		sts = CSMI_STS_BAD_CTRL_CODE;
50262306a36Sopenharmony_ci		break;
50362306a36Sopenharmony_ci
50462306a36Sopenharmony_ci	case CSMI_CC_SMP_PASSTHRU:
50562306a36Sopenharmony_ci	case CSMI_CC_SSP_PASSTHRU:
50662306a36Sopenharmony_ci	case CSMI_CC_STP_PASSTHRU:
50762306a36Sopenharmony_ci	case CSMI_CC_GET_PHY_INFO:
50862306a36Sopenharmony_ci	case CSMI_CC_SET_PHY_INFO:
50962306a36Sopenharmony_ci	case CSMI_CC_GET_LINK_ERRORS:
51062306a36Sopenharmony_ci	case CSMI_CC_GET_SATA_SIG:
51162306a36Sopenharmony_ci	case CSMI_CC_GET_CONN_INFO:
51262306a36Sopenharmony_ci	case CSMI_CC_PHY_CTRL:
51362306a36Sopenharmony_ci
51462306a36Sopenharmony_ci		if (!csmi_ioctl_tunnel(a, ioctl_csmi, rq, sgc,
51562306a36Sopenharmony_ci				       ci->control_code,
51662306a36Sopenharmony_ci				       ESAS2R_TARG_ID_INV)) {
51762306a36Sopenharmony_ci			sts = CSMI_STS_FAILED;
51862306a36Sopenharmony_ci			break;
51962306a36Sopenharmony_ci		}
52062306a36Sopenharmony_ci
52162306a36Sopenharmony_ci		return true;
52262306a36Sopenharmony_ci
52362306a36Sopenharmony_ci	case CSMI_CC_GET_SCSI_ADDR:
52462306a36Sopenharmony_ci	{
52562306a36Sopenharmony_ci		struct atto_csmi_get_scsi_addr *gsa = &ioctl_csmi->scsi_addr;
52662306a36Sopenharmony_ci
52762306a36Sopenharmony_ci		struct scsi_lun lun;
52862306a36Sopenharmony_ci
52962306a36Sopenharmony_ci		memcpy(&lun, gsa->sas_lun, sizeof(struct scsi_lun));
53062306a36Sopenharmony_ci
53162306a36Sopenharmony_ci		if (!check_lun(lun)) {
53262306a36Sopenharmony_ci			sts = CSMI_STS_NO_SCSI_ADDR;
53362306a36Sopenharmony_ci			break;
53462306a36Sopenharmony_ci		}
53562306a36Sopenharmony_ci
53662306a36Sopenharmony_ci		/* make sure the device is present */
53762306a36Sopenharmony_ci		spin_lock_irqsave(&a->mem_lock, flags);
53862306a36Sopenharmony_ci		t = esas2r_targ_db_find_by_sas_addr(a, (u64 *)gsa->sas_addr);
53962306a36Sopenharmony_ci		spin_unlock_irqrestore(&a->mem_lock, flags);
54062306a36Sopenharmony_ci
54162306a36Sopenharmony_ci		if (t == NULL) {
54262306a36Sopenharmony_ci			sts = CSMI_STS_NO_SCSI_ADDR;
54362306a36Sopenharmony_ci			break;
54462306a36Sopenharmony_ci		}
54562306a36Sopenharmony_ci
54662306a36Sopenharmony_ci		gsa->host_index = 0xFF;
54762306a36Sopenharmony_ci		gsa->lun = gsa->sas_lun[1];
54862306a36Sopenharmony_ci		rq->target_id = esas2r_targ_get_id(t, a);
54962306a36Sopenharmony_ci		break;
55062306a36Sopenharmony_ci	}
55162306a36Sopenharmony_ci
55262306a36Sopenharmony_ci	case CSMI_CC_GET_DEV_ADDR:
55362306a36Sopenharmony_ci	{
55462306a36Sopenharmony_ci		struct atto_csmi_get_dev_addr *gda = &ioctl_csmi->dev_addr;
55562306a36Sopenharmony_ci
55662306a36Sopenharmony_ci		/* make sure the target is present */
55762306a36Sopenharmony_ci		t = a->targetdb + rq->target_id;
55862306a36Sopenharmony_ci
55962306a36Sopenharmony_ci		if (t >= a->targetdb_end
56062306a36Sopenharmony_ci		    || t->target_state != TS_PRESENT
56162306a36Sopenharmony_ci		    || t->sas_addr == 0) {
56262306a36Sopenharmony_ci			sts = CSMI_STS_NO_DEV_ADDR;
56362306a36Sopenharmony_ci			break;
56462306a36Sopenharmony_ci		}
56562306a36Sopenharmony_ci
56662306a36Sopenharmony_ci		/* fill in the result */
56762306a36Sopenharmony_ci		*(u64 *)gda->sas_addr = t->sas_addr;
56862306a36Sopenharmony_ci		memset(gda->sas_lun, 0, sizeof(gda->sas_lun));
56962306a36Sopenharmony_ci		gda->sas_lun[1] = (u8)le32_to_cpu(rq->vrq->scsi.flags);
57062306a36Sopenharmony_ci		break;
57162306a36Sopenharmony_ci	}
57262306a36Sopenharmony_ci
57362306a36Sopenharmony_ci	case CSMI_CC_TASK_MGT:
57462306a36Sopenharmony_ci
57562306a36Sopenharmony_ci		/* make sure the target is present */
57662306a36Sopenharmony_ci		t = a->targetdb + rq->target_id;
57762306a36Sopenharmony_ci
57862306a36Sopenharmony_ci		if (t >= a->targetdb_end
57962306a36Sopenharmony_ci		    || t->target_state != TS_PRESENT
58062306a36Sopenharmony_ci		    || !(t->flags & TF_PASS_THRU)) {
58162306a36Sopenharmony_ci			sts = CSMI_STS_NO_DEV_ADDR;
58262306a36Sopenharmony_ci			break;
58362306a36Sopenharmony_ci		}
58462306a36Sopenharmony_ci
58562306a36Sopenharmony_ci		if (!csmi_ioctl_tunnel(a, ioctl_csmi, rq, sgc,
58662306a36Sopenharmony_ci				       ci->control_code,
58762306a36Sopenharmony_ci				       t->phys_targ_id)) {
58862306a36Sopenharmony_ci			sts = CSMI_STS_FAILED;
58962306a36Sopenharmony_ci			break;
59062306a36Sopenharmony_ci		}
59162306a36Sopenharmony_ci
59262306a36Sopenharmony_ci		return true;
59362306a36Sopenharmony_ci
59462306a36Sopenharmony_ci	default:
59562306a36Sopenharmony_ci
59662306a36Sopenharmony_ci		sts = CSMI_STS_BAD_CTRL_CODE;
59762306a36Sopenharmony_ci		break;
59862306a36Sopenharmony_ci	}
59962306a36Sopenharmony_ci
60062306a36Sopenharmony_ci	rq->func_rsp.ioctl_rsp.csmi.csmi_status = cpu_to_le32(sts);
60162306a36Sopenharmony_ci
60262306a36Sopenharmony_ci	return false;
60362306a36Sopenharmony_ci}
60462306a36Sopenharmony_ci
60562306a36Sopenharmony_ci
60662306a36Sopenharmony_cistatic void csmi_ioctl_done_callback(struct esas2r_adapter *a,
60762306a36Sopenharmony_ci				     struct esas2r_request *rq, void *context)
60862306a36Sopenharmony_ci{
60962306a36Sopenharmony_ci	struct atto_csmi *ci = (struct atto_csmi *)context;
61062306a36Sopenharmony_ci	union atto_ioctl_csmi *ioctl_csmi =
61162306a36Sopenharmony_ci		(union atto_ioctl_csmi *)esas2r_buffered_ioctl;
61262306a36Sopenharmony_ci
61362306a36Sopenharmony_ci	switch (ci->control_code) {
61462306a36Sopenharmony_ci	case CSMI_CC_GET_DRVR_INFO:
61562306a36Sopenharmony_ci	{
61662306a36Sopenharmony_ci		struct atto_csmi_get_driver_info *gdi =
61762306a36Sopenharmony_ci			&ioctl_csmi->drvr_info;
61862306a36Sopenharmony_ci
61962306a36Sopenharmony_ci		strcpy(gdi->name, ESAS2R_VERSION_STR);
62062306a36Sopenharmony_ci
62162306a36Sopenharmony_ci		gdi->major_rev = ESAS2R_MAJOR_REV;
62262306a36Sopenharmony_ci		gdi->minor_rev = ESAS2R_MINOR_REV;
62362306a36Sopenharmony_ci		gdi->build_rev = 0;
62462306a36Sopenharmony_ci		gdi->release_rev = 0;
62562306a36Sopenharmony_ci		break;
62662306a36Sopenharmony_ci	}
62762306a36Sopenharmony_ci
62862306a36Sopenharmony_ci	case CSMI_CC_GET_SCSI_ADDR:
62962306a36Sopenharmony_ci	{
63062306a36Sopenharmony_ci		struct atto_csmi_get_scsi_addr *gsa = &ioctl_csmi->scsi_addr;
63162306a36Sopenharmony_ci
63262306a36Sopenharmony_ci		if (le32_to_cpu(rq->func_rsp.ioctl_rsp.csmi.csmi_status) ==
63362306a36Sopenharmony_ci		    CSMI_STS_SUCCESS) {
63462306a36Sopenharmony_ci			gsa->target_id = rq->target_id;
63562306a36Sopenharmony_ci			gsa->path_id = 0;
63662306a36Sopenharmony_ci		}
63762306a36Sopenharmony_ci
63862306a36Sopenharmony_ci		break;
63962306a36Sopenharmony_ci	}
64062306a36Sopenharmony_ci	}
64162306a36Sopenharmony_ci
64262306a36Sopenharmony_ci	ci->status = le32_to_cpu(rq->func_rsp.ioctl_rsp.csmi.csmi_status);
64362306a36Sopenharmony_ci}
64462306a36Sopenharmony_ci
64562306a36Sopenharmony_ci
64662306a36Sopenharmony_cistatic u8 handle_csmi_ioctl(struct esas2r_adapter *a, struct atto_csmi *ci)
64762306a36Sopenharmony_ci{
64862306a36Sopenharmony_ci	struct esas2r_buffered_ioctl bi;
64962306a36Sopenharmony_ci
65062306a36Sopenharmony_ci	memset(&bi, 0, sizeof(bi));
65162306a36Sopenharmony_ci
65262306a36Sopenharmony_ci	bi.a = a;
65362306a36Sopenharmony_ci	bi.ioctl = &ci->data;
65462306a36Sopenharmony_ci	bi.length = sizeof(union atto_ioctl_csmi);
65562306a36Sopenharmony_ci	bi.offset = 0;
65662306a36Sopenharmony_ci	bi.callback = csmi_ioctl_callback;
65762306a36Sopenharmony_ci	bi.context = ci;
65862306a36Sopenharmony_ci	bi.done_callback = csmi_ioctl_done_callback;
65962306a36Sopenharmony_ci	bi.done_context = ci;
66062306a36Sopenharmony_ci
66162306a36Sopenharmony_ci	return handle_buffered_ioctl(&bi);
66262306a36Sopenharmony_ci}
66362306a36Sopenharmony_ci
66462306a36Sopenharmony_ci/* ATTO HBA ioctl support */
66562306a36Sopenharmony_ci
66662306a36Sopenharmony_ci/* Tunnel an ATTO HBA IOCTL to the back end driver for processing. */
66762306a36Sopenharmony_cistatic bool hba_ioctl_tunnel(struct esas2r_adapter *a,
66862306a36Sopenharmony_ci			     struct atto_ioctl *hi,
66962306a36Sopenharmony_ci			     struct esas2r_request *rq,
67062306a36Sopenharmony_ci			     struct esas2r_sg_context *sgc)
67162306a36Sopenharmony_ci{
67262306a36Sopenharmony_ci	esas2r_sgc_init(sgc, a, rq, rq->vrq->ioctl.sge);
67362306a36Sopenharmony_ci
67462306a36Sopenharmony_ci	esas2r_build_ioctl_req(a, rq, sgc->length, VDA_IOCTL_HBA);
67562306a36Sopenharmony_ci
67662306a36Sopenharmony_ci	if (!esas2r_build_sg_list(a, rq, sgc)) {
67762306a36Sopenharmony_ci		hi->status = ATTO_STS_OUT_OF_RSRC;
67862306a36Sopenharmony_ci
67962306a36Sopenharmony_ci		return false;
68062306a36Sopenharmony_ci	}
68162306a36Sopenharmony_ci
68262306a36Sopenharmony_ci	esas2r_start_request(a, rq);
68362306a36Sopenharmony_ci
68462306a36Sopenharmony_ci	return true;
68562306a36Sopenharmony_ci}
68662306a36Sopenharmony_ci
68762306a36Sopenharmony_cistatic void scsi_passthru_comp_cb(struct esas2r_adapter *a,
68862306a36Sopenharmony_ci				  struct esas2r_request *rq)
68962306a36Sopenharmony_ci{
69062306a36Sopenharmony_ci	struct atto_ioctl *hi = (struct atto_ioctl *)rq->aux_req_cx;
69162306a36Sopenharmony_ci	struct atto_hba_scsi_pass_thru *spt = &hi->data.scsi_pass_thru;
69262306a36Sopenharmony_ci	u8 sts = ATTO_SPT_RS_FAILED;
69362306a36Sopenharmony_ci
69462306a36Sopenharmony_ci	spt->scsi_status = rq->func_rsp.scsi_rsp.scsi_stat;
69562306a36Sopenharmony_ci	spt->sense_length = rq->sense_len;
69662306a36Sopenharmony_ci	spt->residual_length =
69762306a36Sopenharmony_ci		le32_to_cpu(rq->func_rsp.scsi_rsp.residual_length);
69862306a36Sopenharmony_ci
69962306a36Sopenharmony_ci	switch (rq->req_stat) {
70062306a36Sopenharmony_ci	case RS_SUCCESS:
70162306a36Sopenharmony_ci	case RS_SCSI_ERROR:
70262306a36Sopenharmony_ci		sts = ATTO_SPT_RS_SUCCESS;
70362306a36Sopenharmony_ci		break;
70462306a36Sopenharmony_ci	case RS_UNDERRUN:
70562306a36Sopenharmony_ci		sts = ATTO_SPT_RS_UNDERRUN;
70662306a36Sopenharmony_ci		break;
70762306a36Sopenharmony_ci	case RS_OVERRUN:
70862306a36Sopenharmony_ci		sts = ATTO_SPT_RS_OVERRUN;
70962306a36Sopenharmony_ci		break;
71062306a36Sopenharmony_ci	case RS_SEL:
71162306a36Sopenharmony_ci	case RS_SEL2:
71262306a36Sopenharmony_ci		sts = ATTO_SPT_RS_NO_DEVICE;
71362306a36Sopenharmony_ci		break;
71462306a36Sopenharmony_ci	case RS_NO_LUN:
71562306a36Sopenharmony_ci		sts = ATTO_SPT_RS_NO_LUN;
71662306a36Sopenharmony_ci		break;
71762306a36Sopenharmony_ci	case RS_TIMEOUT:
71862306a36Sopenharmony_ci		sts = ATTO_SPT_RS_TIMEOUT;
71962306a36Sopenharmony_ci		break;
72062306a36Sopenharmony_ci	case RS_DEGRADED:
72162306a36Sopenharmony_ci		sts = ATTO_SPT_RS_DEGRADED;
72262306a36Sopenharmony_ci		break;
72362306a36Sopenharmony_ci	case RS_BUSY:
72462306a36Sopenharmony_ci		sts = ATTO_SPT_RS_BUSY;
72562306a36Sopenharmony_ci		break;
72662306a36Sopenharmony_ci	case RS_ABORTED:
72762306a36Sopenharmony_ci		sts = ATTO_SPT_RS_ABORTED;
72862306a36Sopenharmony_ci		break;
72962306a36Sopenharmony_ci	case RS_RESET:
73062306a36Sopenharmony_ci		sts = ATTO_SPT_RS_BUS_RESET;
73162306a36Sopenharmony_ci		break;
73262306a36Sopenharmony_ci	}
73362306a36Sopenharmony_ci
73462306a36Sopenharmony_ci	spt->req_status = sts;
73562306a36Sopenharmony_ci
73662306a36Sopenharmony_ci	/* Update the target ID to the next one present. */
73762306a36Sopenharmony_ci	spt->target_id =
73862306a36Sopenharmony_ci		esas2r_targ_db_find_next_present(a, (u16)spt->target_id);
73962306a36Sopenharmony_ci
74062306a36Sopenharmony_ci	/* Done, call the completion callback. */
74162306a36Sopenharmony_ci	(*rq->aux_req_cb)(a, rq);
74262306a36Sopenharmony_ci}
74362306a36Sopenharmony_ci
74462306a36Sopenharmony_cistatic int hba_ioctl_callback(struct esas2r_adapter *a,
74562306a36Sopenharmony_ci			      struct esas2r_request *rq,
74662306a36Sopenharmony_ci			      struct esas2r_sg_context *sgc,
74762306a36Sopenharmony_ci			      void *context)
74862306a36Sopenharmony_ci{
74962306a36Sopenharmony_ci	struct atto_ioctl *hi = (struct atto_ioctl *)esas2r_buffered_ioctl;
75062306a36Sopenharmony_ci
75162306a36Sopenharmony_ci	hi->status = ATTO_STS_SUCCESS;
75262306a36Sopenharmony_ci
75362306a36Sopenharmony_ci	switch (hi->function) {
75462306a36Sopenharmony_ci	case ATTO_FUNC_GET_ADAP_INFO:
75562306a36Sopenharmony_ci	{
75662306a36Sopenharmony_ci		u8 *class_code = (u8 *)&a->pcid->class;
75762306a36Sopenharmony_ci
75862306a36Sopenharmony_ci		struct atto_hba_get_adapter_info *gai =
75962306a36Sopenharmony_ci			&hi->data.get_adap_info;
76062306a36Sopenharmony_ci
76162306a36Sopenharmony_ci		if (hi->flags & HBAF_TUNNEL) {
76262306a36Sopenharmony_ci			hi->status = ATTO_STS_UNSUPPORTED;
76362306a36Sopenharmony_ci			break;
76462306a36Sopenharmony_ci		}
76562306a36Sopenharmony_ci
76662306a36Sopenharmony_ci		if (hi->version > ATTO_VER_GET_ADAP_INFO0) {
76762306a36Sopenharmony_ci			hi->status = ATTO_STS_INV_VERSION;
76862306a36Sopenharmony_ci			hi->version = ATTO_VER_GET_ADAP_INFO0;
76962306a36Sopenharmony_ci			break;
77062306a36Sopenharmony_ci		}
77162306a36Sopenharmony_ci
77262306a36Sopenharmony_ci		memset(gai, 0, sizeof(*gai));
77362306a36Sopenharmony_ci
77462306a36Sopenharmony_ci		gai->pci.vendor_id = a->pcid->vendor;
77562306a36Sopenharmony_ci		gai->pci.device_id = a->pcid->device;
77662306a36Sopenharmony_ci		gai->pci.ss_vendor_id = a->pcid->subsystem_vendor;
77762306a36Sopenharmony_ci		gai->pci.ss_device_id = a->pcid->subsystem_device;
77862306a36Sopenharmony_ci		gai->pci.class_code[0] = class_code[0];
77962306a36Sopenharmony_ci		gai->pci.class_code[1] = class_code[1];
78062306a36Sopenharmony_ci		gai->pci.class_code[2] = class_code[2];
78162306a36Sopenharmony_ci		gai->pci.rev_id = a->pcid->revision;
78262306a36Sopenharmony_ci		gai->pci.bus_num = a->pcid->bus->number;
78362306a36Sopenharmony_ci		gai->pci.dev_num = PCI_SLOT(a->pcid->devfn);
78462306a36Sopenharmony_ci		gai->pci.func_num = PCI_FUNC(a->pcid->devfn);
78562306a36Sopenharmony_ci
78662306a36Sopenharmony_ci		if (pci_is_pcie(a->pcid)) {
78762306a36Sopenharmony_ci			u16 stat;
78862306a36Sopenharmony_ci			u32 caps;
78962306a36Sopenharmony_ci
79062306a36Sopenharmony_ci			pcie_capability_read_word(a->pcid, PCI_EXP_LNKSTA,
79162306a36Sopenharmony_ci						  &stat);
79262306a36Sopenharmony_ci			pcie_capability_read_dword(a->pcid, PCI_EXP_LNKCAP,
79362306a36Sopenharmony_ci						   &caps);
79462306a36Sopenharmony_ci
79562306a36Sopenharmony_ci			gai->pci.link_speed_curr =
79662306a36Sopenharmony_ci				(u8)(stat & PCI_EXP_LNKSTA_CLS);
79762306a36Sopenharmony_ci			gai->pci.link_speed_max =
79862306a36Sopenharmony_ci				(u8)(caps & PCI_EXP_LNKCAP_SLS);
79962306a36Sopenharmony_ci			gai->pci.link_width_curr =
80062306a36Sopenharmony_ci				(u8)((stat & PCI_EXP_LNKSTA_NLW)
80162306a36Sopenharmony_ci				     >> PCI_EXP_LNKSTA_NLW_SHIFT);
80262306a36Sopenharmony_ci			gai->pci.link_width_max =
80362306a36Sopenharmony_ci				(u8)((caps & PCI_EXP_LNKCAP_MLW)
80462306a36Sopenharmony_ci				     >> 4);
80562306a36Sopenharmony_ci		}
80662306a36Sopenharmony_ci
80762306a36Sopenharmony_ci		gai->pci.msi_vector_cnt = 1;
80862306a36Sopenharmony_ci
80962306a36Sopenharmony_ci		if (a->pcid->msix_enabled)
81062306a36Sopenharmony_ci			gai->pci.interrupt_mode = ATTO_GAI_PCIIM_MSIX;
81162306a36Sopenharmony_ci		else if (a->pcid->msi_enabled)
81262306a36Sopenharmony_ci			gai->pci.interrupt_mode = ATTO_GAI_PCIIM_MSI;
81362306a36Sopenharmony_ci		else
81462306a36Sopenharmony_ci			gai->pci.interrupt_mode = ATTO_GAI_PCIIM_LEGACY;
81562306a36Sopenharmony_ci
81662306a36Sopenharmony_ci		gai->adap_type = ATTO_GAI_AT_ESASRAID2;
81762306a36Sopenharmony_ci
81862306a36Sopenharmony_ci		if (test_bit(AF2_THUNDERLINK, &a->flags2))
81962306a36Sopenharmony_ci			gai->adap_type = ATTO_GAI_AT_TLSASHBA;
82062306a36Sopenharmony_ci
82162306a36Sopenharmony_ci		if (test_bit(AF_DEGRADED_MODE, &a->flags))
82262306a36Sopenharmony_ci			gai->adap_flags |= ATTO_GAI_AF_DEGRADED;
82362306a36Sopenharmony_ci
82462306a36Sopenharmony_ci		gai->adap_flags |= ATTO_GAI_AF_SPT_SUPP |
82562306a36Sopenharmony_ci				   ATTO_GAI_AF_DEVADDR_SUPP;
82662306a36Sopenharmony_ci
82762306a36Sopenharmony_ci		if (a->pcid->subsystem_device == ATTO_ESAS_R60F
82862306a36Sopenharmony_ci		    || a->pcid->subsystem_device == ATTO_ESAS_R608
82962306a36Sopenharmony_ci		    || a->pcid->subsystem_device == ATTO_ESAS_R644
83062306a36Sopenharmony_ci		    || a->pcid->subsystem_device == ATTO_TSSC_3808E)
83162306a36Sopenharmony_ci			gai->adap_flags |= ATTO_GAI_AF_VIRT_SES;
83262306a36Sopenharmony_ci
83362306a36Sopenharmony_ci		gai->num_ports = ESAS2R_NUM_PHYS;
83462306a36Sopenharmony_ci		gai->num_phys = ESAS2R_NUM_PHYS;
83562306a36Sopenharmony_ci
83662306a36Sopenharmony_ci		strcpy(gai->firmware_rev, a->fw_rev);
83762306a36Sopenharmony_ci		strcpy(gai->flash_rev, a->flash_rev);
83862306a36Sopenharmony_ci		strcpy(gai->model_name_short, esas2r_get_model_name_short(a));
83962306a36Sopenharmony_ci		strcpy(gai->model_name, esas2r_get_model_name(a));
84062306a36Sopenharmony_ci
84162306a36Sopenharmony_ci		gai->num_targets = ESAS2R_MAX_TARGETS;
84262306a36Sopenharmony_ci
84362306a36Sopenharmony_ci		gai->num_busses = 1;
84462306a36Sopenharmony_ci		gai->num_targsper_bus = gai->num_targets;
84562306a36Sopenharmony_ci		gai->num_lunsper_targ = 256;
84662306a36Sopenharmony_ci
84762306a36Sopenharmony_ci		if (a->pcid->subsystem_device == ATTO_ESAS_R6F0
84862306a36Sopenharmony_ci		    || a->pcid->subsystem_device == ATTO_ESAS_R60F)
84962306a36Sopenharmony_ci			gai->num_connectors = 4;
85062306a36Sopenharmony_ci		else
85162306a36Sopenharmony_ci			gai->num_connectors = 2;
85262306a36Sopenharmony_ci
85362306a36Sopenharmony_ci		gai->adap_flags2 |= ATTO_GAI_AF2_ADAP_CTRL_SUPP;
85462306a36Sopenharmony_ci
85562306a36Sopenharmony_ci		gai->num_targets_backend = a->num_targets_backend;
85662306a36Sopenharmony_ci
85762306a36Sopenharmony_ci		gai->tunnel_flags = a->ioctl_tunnel
85862306a36Sopenharmony_ci				    & (ATTO_GAI_TF_MEM_RW
85962306a36Sopenharmony_ci				       | ATTO_GAI_TF_TRACE
86062306a36Sopenharmony_ci				       | ATTO_GAI_TF_SCSI_PASS_THRU
86162306a36Sopenharmony_ci				       | ATTO_GAI_TF_GET_DEV_ADDR
86262306a36Sopenharmony_ci				       | ATTO_GAI_TF_PHY_CTRL
86362306a36Sopenharmony_ci				       | ATTO_GAI_TF_CONN_CTRL
86462306a36Sopenharmony_ci				       | ATTO_GAI_TF_GET_DEV_INFO);
86562306a36Sopenharmony_ci		break;
86662306a36Sopenharmony_ci	}
86762306a36Sopenharmony_ci
86862306a36Sopenharmony_ci	case ATTO_FUNC_GET_ADAP_ADDR:
86962306a36Sopenharmony_ci	{
87062306a36Sopenharmony_ci		struct atto_hba_get_adapter_address *gaa =
87162306a36Sopenharmony_ci			&hi->data.get_adap_addr;
87262306a36Sopenharmony_ci
87362306a36Sopenharmony_ci		if (hi->flags & HBAF_TUNNEL) {
87462306a36Sopenharmony_ci			hi->status = ATTO_STS_UNSUPPORTED;
87562306a36Sopenharmony_ci			break;
87662306a36Sopenharmony_ci		}
87762306a36Sopenharmony_ci
87862306a36Sopenharmony_ci		if (hi->version > ATTO_VER_GET_ADAP_ADDR0) {
87962306a36Sopenharmony_ci			hi->status = ATTO_STS_INV_VERSION;
88062306a36Sopenharmony_ci			hi->version = ATTO_VER_GET_ADAP_ADDR0;
88162306a36Sopenharmony_ci		} else if (gaa->addr_type == ATTO_GAA_AT_PORT
88262306a36Sopenharmony_ci			   || gaa->addr_type == ATTO_GAA_AT_NODE) {
88362306a36Sopenharmony_ci			if (gaa->addr_type == ATTO_GAA_AT_PORT
88462306a36Sopenharmony_ci			    && gaa->port_id >= ESAS2R_NUM_PHYS) {
88562306a36Sopenharmony_ci				hi->status = ATTO_STS_NOT_APPL;
88662306a36Sopenharmony_ci			} else {
88762306a36Sopenharmony_ci				memcpy((u64 *)gaa->address,
88862306a36Sopenharmony_ci				       &a->nvram->sas_addr[0], sizeof(u64));
88962306a36Sopenharmony_ci				gaa->addr_len = sizeof(u64);
89062306a36Sopenharmony_ci			}
89162306a36Sopenharmony_ci		} else {
89262306a36Sopenharmony_ci			hi->status = ATTO_STS_INV_PARAM;
89362306a36Sopenharmony_ci		}
89462306a36Sopenharmony_ci
89562306a36Sopenharmony_ci		break;
89662306a36Sopenharmony_ci	}
89762306a36Sopenharmony_ci
89862306a36Sopenharmony_ci	case ATTO_FUNC_MEM_RW:
89962306a36Sopenharmony_ci	{
90062306a36Sopenharmony_ci		if (hi->flags & HBAF_TUNNEL) {
90162306a36Sopenharmony_ci			if (hba_ioctl_tunnel(a, hi, rq, sgc))
90262306a36Sopenharmony_ci				return true;
90362306a36Sopenharmony_ci
90462306a36Sopenharmony_ci			break;
90562306a36Sopenharmony_ci		}
90662306a36Sopenharmony_ci
90762306a36Sopenharmony_ci		hi->status = ATTO_STS_UNSUPPORTED;
90862306a36Sopenharmony_ci
90962306a36Sopenharmony_ci		break;
91062306a36Sopenharmony_ci	}
91162306a36Sopenharmony_ci
91262306a36Sopenharmony_ci	case ATTO_FUNC_TRACE:
91362306a36Sopenharmony_ci	{
91462306a36Sopenharmony_ci		struct atto_hba_trace *trc = &hi->data.trace;
91562306a36Sopenharmony_ci
91662306a36Sopenharmony_ci		if (hi->flags & HBAF_TUNNEL) {
91762306a36Sopenharmony_ci			if (hba_ioctl_tunnel(a, hi, rq, sgc))
91862306a36Sopenharmony_ci				return true;
91962306a36Sopenharmony_ci
92062306a36Sopenharmony_ci			break;
92162306a36Sopenharmony_ci		}
92262306a36Sopenharmony_ci
92362306a36Sopenharmony_ci		if (hi->version > ATTO_VER_TRACE1) {
92462306a36Sopenharmony_ci			hi->status = ATTO_STS_INV_VERSION;
92562306a36Sopenharmony_ci			hi->version = ATTO_VER_TRACE1;
92662306a36Sopenharmony_ci			break;
92762306a36Sopenharmony_ci		}
92862306a36Sopenharmony_ci
92962306a36Sopenharmony_ci		if (trc->trace_type == ATTO_TRC_TT_FWCOREDUMP
93062306a36Sopenharmony_ci		    && hi->version >= ATTO_VER_TRACE1) {
93162306a36Sopenharmony_ci			if (trc->trace_func == ATTO_TRC_TF_UPLOAD) {
93262306a36Sopenharmony_ci				u32 len = hi->data_length;
93362306a36Sopenharmony_ci				u32 offset = trc->current_offset;
93462306a36Sopenharmony_ci				u32 total_len = ESAS2R_FWCOREDUMP_SZ;
93562306a36Sopenharmony_ci
93662306a36Sopenharmony_ci				/* Size is zero if a core dump isn't present */
93762306a36Sopenharmony_ci				if (!test_bit(AF2_COREDUMP_SAVED, &a->flags2))
93862306a36Sopenharmony_ci					total_len = 0;
93962306a36Sopenharmony_ci
94062306a36Sopenharmony_ci				if (len > total_len)
94162306a36Sopenharmony_ci					len = total_len;
94262306a36Sopenharmony_ci
94362306a36Sopenharmony_ci				if (offset >= total_len
94462306a36Sopenharmony_ci				    || offset + len > total_len
94562306a36Sopenharmony_ci				    || len == 0) {
94662306a36Sopenharmony_ci					hi->status = ATTO_STS_INV_PARAM;
94762306a36Sopenharmony_ci					break;
94862306a36Sopenharmony_ci				}
94962306a36Sopenharmony_ci
95062306a36Sopenharmony_ci				memcpy(trc->contents,
95162306a36Sopenharmony_ci				       a->fw_coredump_buff + offset,
95262306a36Sopenharmony_ci				       len);
95362306a36Sopenharmony_ci				hi->data_length = len;
95462306a36Sopenharmony_ci			} else if (trc->trace_func == ATTO_TRC_TF_RESET) {
95562306a36Sopenharmony_ci				memset(a->fw_coredump_buff, 0,
95662306a36Sopenharmony_ci				       ESAS2R_FWCOREDUMP_SZ);
95762306a36Sopenharmony_ci
95862306a36Sopenharmony_ci				clear_bit(AF2_COREDUMP_SAVED, &a->flags2);
95962306a36Sopenharmony_ci			} else if (trc->trace_func != ATTO_TRC_TF_GET_INFO) {
96062306a36Sopenharmony_ci				hi->status = ATTO_STS_UNSUPPORTED;
96162306a36Sopenharmony_ci				break;
96262306a36Sopenharmony_ci			}
96362306a36Sopenharmony_ci
96462306a36Sopenharmony_ci			/* Always return all the info we can. */
96562306a36Sopenharmony_ci			trc->trace_mask = 0;
96662306a36Sopenharmony_ci			trc->current_offset = 0;
96762306a36Sopenharmony_ci			trc->total_length = ESAS2R_FWCOREDUMP_SZ;
96862306a36Sopenharmony_ci
96962306a36Sopenharmony_ci			/* Return zero length buffer if core dump not present */
97062306a36Sopenharmony_ci			if (!test_bit(AF2_COREDUMP_SAVED, &a->flags2))
97162306a36Sopenharmony_ci				trc->total_length = 0;
97262306a36Sopenharmony_ci		} else {
97362306a36Sopenharmony_ci			hi->status = ATTO_STS_UNSUPPORTED;
97462306a36Sopenharmony_ci		}
97562306a36Sopenharmony_ci
97662306a36Sopenharmony_ci		break;
97762306a36Sopenharmony_ci	}
97862306a36Sopenharmony_ci
97962306a36Sopenharmony_ci	case ATTO_FUNC_SCSI_PASS_THRU:
98062306a36Sopenharmony_ci	{
98162306a36Sopenharmony_ci		struct atto_hba_scsi_pass_thru *spt = &hi->data.scsi_pass_thru;
98262306a36Sopenharmony_ci		struct scsi_lun lun;
98362306a36Sopenharmony_ci
98462306a36Sopenharmony_ci		memcpy(&lun, spt->lun, sizeof(struct scsi_lun));
98562306a36Sopenharmony_ci
98662306a36Sopenharmony_ci		if (hi->flags & HBAF_TUNNEL) {
98762306a36Sopenharmony_ci			if (hba_ioctl_tunnel(a, hi, rq, sgc))
98862306a36Sopenharmony_ci				return true;
98962306a36Sopenharmony_ci
99062306a36Sopenharmony_ci			break;
99162306a36Sopenharmony_ci		}
99262306a36Sopenharmony_ci
99362306a36Sopenharmony_ci		if (hi->version > ATTO_VER_SCSI_PASS_THRU0) {
99462306a36Sopenharmony_ci			hi->status = ATTO_STS_INV_VERSION;
99562306a36Sopenharmony_ci			hi->version = ATTO_VER_SCSI_PASS_THRU0;
99662306a36Sopenharmony_ci			break;
99762306a36Sopenharmony_ci		}
99862306a36Sopenharmony_ci
99962306a36Sopenharmony_ci		if (spt->target_id >= ESAS2R_MAX_TARGETS || !check_lun(lun)) {
100062306a36Sopenharmony_ci			hi->status = ATTO_STS_INV_PARAM;
100162306a36Sopenharmony_ci			break;
100262306a36Sopenharmony_ci		}
100362306a36Sopenharmony_ci
100462306a36Sopenharmony_ci		esas2r_sgc_init(sgc, a, rq, NULL);
100562306a36Sopenharmony_ci
100662306a36Sopenharmony_ci		sgc->length = hi->data_length;
100762306a36Sopenharmony_ci		sgc->cur_offset += offsetof(struct atto_ioctl, data.byte)
100862306a36Sopenharmony_ci				   + sizeof(struct atto_hba_scsi_pass_thru);
100962306a36Sopenharmony_ci
101062306a36Sopenharmony_ci		/* Finish request initialization */
101162306a36Sopenharmony_ci		rq->target_id = (u16)spt->target_id;
101262306a36Sopenharmony_ci		rq->vrq->scsi.flags |= cpu_to_le32(spt->lun[1]);
101362306a36Sopenharmony_ci		memcpy(rq->vrq->scsi.cdb, spt->cdb, 16);
101462306a36Sopenharmony_ci		rq->vrq->scsi.length = cpu_to_le32(hi->data_length);
101562306a36Sopenharmony_ci		rq->sense_len = spt->sense_length;
101662306a36Sopenharmony_ci		rq->sense_buf = (u8 *)spt->sense_data;
101762306a36Sopenharmony_ci		/* NOTE: we ignore spt->timeout */
101862306a36Sopenharmony_ci
101962306a36Sopenharmony_ci		/*
102062306a36Sopenharmony_ci		 * always usurp the completion callback since the interrupt
102162306a36Sopenharmony_ci		 * callback mechanism may be used.
102262306a36Sopenharmony_ci		 */
102362306a36Sopenharmony_ci
102462306a36Sopenharmony_ci		rq->aux_req_cx = hi;
102562306a36Sopenharmony_ci		rq->aux_req_cb = rq->comp_cb;
102662306a36Sopenharmony_ci		rq->comp_cb = scsi_passthru_comp_cb;
102762306a36Sopenharmony_ci
102862306a36Sopenharmony_ci		if (spt->flags & ATTO_SPTF_DATA_IN) {
102962306a36Sopenharmony_ci			rq->vrq->scsi.flags |= cpu_to_le32(FCP_CMND_RDD);
103062306a36Sopenharmony_ci		} else if (spt->flags & ATTO_SPTF_DATA_OUT) {
103162306a36Sopenharmony_ci			rq->vrq->scsi.flags |= cpu_to_le32(FCP_CMND_WRD);
103262306a36Sopenharmony_ci		} else {
103362306a36Sopenharmony_ci			if (sgc->length) {
103462306a36Sopenharmony_ci				hi->status = ATTO_STS_INV_PARAM;
103562306a36Sopenharmony_ci				break;
103662306a36Sopenharmony_ci			}
103762306a36Sopenharmony_ci		}
103862306a36Sopenharmony_ci
103962306a36Sopenharmony_ci		if (spt->flags & ATTO_SPTF_ORDERED_Q)
104062306a36Sopenharmony_ci			rq->vrq->scsi.flags |=
104162306a36Sopenharmony_ci				cpu_to_le32(FCP_CMND_TA_ORDRD_Q);
104262306a36Sopenharmony_ci		else if (spt->flags & ATTO_SPTF_HEAD_OF_Q)
104362306a36Sopenharmony_ci			rq->vrq->scsi.flags |= cpu_to_le32(FCP_CMND_TA_HEAD_Q);
104462306a36Sopenharmony_ci
104562306a36Sopenharmony_ci
104662306a36Sopenharmony_ci		if (!esas2r_build_sg_list(a, rq, sgc)) {
104762306a36Sopenharmony_ci			hi->status = ATTO_STS_OUT_OF_RSRC;
104862306a36Sopenharmony_ci			break;
104962306a36Sopenharmony_ci		}
105062306a36Sopenharmony_ci
105162306a36Sopenharmony_ci		esas2r_start_request(a, rq);
105262306a36Sopenharmony_ci
105362306a36Sopenharmony_ci		return true;
105462306a36Sopenharmony_ci	}
105562306a36Sopenharmony_ci
105662306a36Sopenharmony_ci	case ATTO_FUNC_GET_DEV_ADDR:
105762306a36Sopenharmony_ci	{
105862306a36Sopenharmony_ci		struct atto_hba_get_device_address *gda =
105962306a36Sopenharmony_ci			&hi->data.get_dev_addr;
106062306a36Sopenharmony_ci		struct esas2r_target *t;
106162306a36Sopenharmony_ci
106262306a36Sopenharmony_ci		if (hi->flags & HBAF_TUNNEL) {
106362306a36Sopenharmony_ci			if (hba_ioctl_tunnel(a, hi, rq, sgc))
106462306a36Sopenharmony_ci				return true;
106562306a36Sopenharmony_ci
106662306a36Sopenharmony_ci			break;
106762306a36Sopenharmony_ci		}
106862306a36Sopenharmony_ci
106962306a36Sopenharmony_ci		if (hi->version > ATTO_VER_GET_DEV_ADDR0) {
107062306a36Sopenharmony_ci			hi->status = ATTO_STS_INV_VERSION;
107162306a36Sopenharmony_ci			hi->version = ATTO_VER_GET_DEV_ADDR0;
107262306a36Sopenharmony_ci			break;
107362306a36Sopenharmony_ci		}
107462306a36Sopenharmony_ci
107562306a36Sopenharmony_ci		if (gda->target_id >= ESAS2R_MAX_TARGETS) {
107662306a36Sopenharmony_ci			hi->status = ATTO_STS_INV_PARAM;
107762306a36Sopenharmony_ci			break;
107862306a36Sopenharmony_ci		}
107962306a36Sopenharmony_ci
108062306a36Sopenharmony_ci		t = a->targetdb + (u16)gda->target_id;
108162306a36Sopenharmony_ci
108262306a36Sopenharmony_ci		if (t->target_state != TS_PRESENT) {
108362306a36Sopenharmony_ci			hi->status = ATTO_STS_FAILED;
108462306a36Sopenharmony_ci		} else if (gda->addr_type == ATTO_GDA_AT_PORT) {
108562306a36Sopenharmony_ci			if (t->sas_addr == 0) {
108662306a36Sopenharmony_ci				hi->status = ATTO_STS_UNSUPPORTED;
108762306a36Sopenharmony_ci			} else {
108862306a36Sopenharmony_ci				*(u64 *)gda->address = t->sas_addr;
108962306a36Sopenharmony_ci
109062306a36Sopenharmony_ci				gda->addr_len = sizeof(u64);
109162306a36Sopenharmony_ci			}
109262306a36Sopenharmony_ci		} else if (gda->addr_type == ATTO_GDA_AT_NODE) {
109362306a36Sopenharmony_ci			hi->status = ATTO_STS_NOT_APPL;
109462306a36Sopenharmony_ci		} else {
109562306a36Sopenharmony_ci			hi->status = ATTO_STS_INV_PARAM;
109662306a36Sopenharmony_ci		}
109762306a36Sopenharmony_ci
109862306a36Sopenharmony_ci		/* update the target ID to the next one present. */
109962306a36Sopenharmony_ci
110062306a36Sopenharmony_ci		gda->target_id =
110162306a36Sopenharmony_ci			esas2r_targ_db_find_next_present(a,
110262306a36Sopenharmony_ci							 (u16)gda->target_id);
110362306a36Sopenharmony_ci		break;
110462306a36Sopenharmony_ci	}
110562306a36Sopenharmony_ci
110662306a36Sopenharmony_ci	case ATTO_FUNC_PHY_CTRL:
110762306a36Sopenharmony_ci	case ATTO_FUNC_CONN_CTRL:
110862306a36Sopenharmony_ci	{
110962306a36Sopenharmony_ci		if (hba_ioctl_tunnel(a, hi, rq, sgc))
111062306a36Sopenharmony_ci			return true;
111162306a36Sopenharmony_ci
111262306a36Sopenharmony_ci		break;
111362306a36Sopenharmony_ci	}
111462306a36Sopenharmony_ci
111562306a36Sopenharmony_ci	case ATTO_FUNC_ADAP_CTRL:
111662306a36Sopenharmony_ci	{
111762306a36Sopenharmony_ci		struct atto_hba_adap_ctrl *ac = &hi->data.adap_ctrl;
111862306a36Sopenharmony_ci
111962306a36Sopenharmony_ci		if (hi->flags & HBAF_TUNNEL) {
112062306a36Sopenharmony_ci			hi->status = ATTO_STS_UNSUPPORTED;
112162306a36Sopenharmony_ci			break;
112262306a36Sopenharmony_ci		}
112362306a36Sopenharmony_ci
112462306a36Sopenharmony_ci		if (hi->version > ATTO_VER_ADAP_CTRL0) {
112562306a36Sopenharmony_ci			hi->status = ATTO_STS_INV_VERSION;
112662306a36Sopenharmony_ci			hi->version = ATTO_VER_ADAP_CTRL0;
112762306a36Sopenharmony_ci			break;
112862306a36Sopenharmony_ci		}
112962306a36Sopenharmony_ci
113062306a36Sopenharmony_ci		if (ac->adap_func == ATTO_AC_AF_HARD_RST) {
113162306a36Sopenharmony_ci			esas2r_reset_adapter(a);
113262306a36Sopenharmony_ci		} else if (ac->adap_func != ATTO_AC_AF_GET_STATE) {
113362306a36Sopenharmony_ci			hi->status = ATTO_STS_UNSUPPORTED;
113462306a36Sopenharmony_ci			break;
113562306a36Sopenharmony_ci		}
113662306a36Sopenharmony_ci
113762306a36Sopenharmony_ci		if (test_bit(AF_CHPRST_NEEDED, &a->flags))
113862306a36Sopenharmony_ci			ac->adap_state = ATTO_AC_AS_RST_SCHED;
113962306a36Sopenharmony_ci		else if (test_bit(AF_CHPRST_PENDING, &a->flags))
114062306a36Sopenharmony_ci			ac->adap_state = ATTO_AC_AS_RST_IN_PROG;
114162306a36Sopenharmony_ci		else if (test_bit(AF_DISC_PENDING, &a->flags))
114262306a36Sopenharmony_ci			ac->adap_state = ATTO_AC_AS_RST_DISC;
114362306a36Sopenharmony_ci		else if (test_bit(AF_DISABLED, &a->flags))
114462306a36Sopenharmony_ci			ac->adap_state = ATTO_AC_AS_DISABLED;
114562306a36Sopenharmony_ci		else if (test_bit(AF_DEGRADED_MODE, &a->flags))
114662306a36Sopenharmony_ci			ac->adap_state = ATTO_AC_AS_DEGRADED;
114762306a36Sopenharmony_ci		else
114862306a36Sopenharmony_ci			ac->adap_state = ATTO_AC_AS_OK;
114962306a36Sopenharmony_ci
115062306a36Sopenharmony_ci		break;
115162306a36Sopenharmony_ci	}
115262306a36Sopenharmony_ci
115362306a36Sopenharmony_ci	case ATTO_FUNC_GET_DEV_INFO:
115462306a36Sopenharmony_ci	{
115562306a36Sopenharmony_ci		struct atto_hba_get_device_info *gdi = &hi->data.get_dev_info;
115662306a36Sopenharmony_ci		struct esas2r_target *t;
115762306a36Sopenharmony_ci
115862306a36Sopenharmony_ci		if (hi->flags & HBAF_TUNNEL) {
115962306a36Sopenharmony_ci			if (hba_ioctl_tunnel(a, hi, rq, sgc))
116062306a36Sopenharmony_ci				return true;
116162306a36Sopenharmony_ci
116262306a36Sopenharmony_ci			break;
116362306a36Sopenharmony_ci		}
116462306a36Sopenharmony_ci
116562306a36Sopenharmony_ci		if (hi->version > ATTO_VER_GET_DEV_INFO0) {
116662306a36Sopenharmony_ci			hi->status = ATTO_STS_INV_VERSION;
116762306a36Sopenharmony_ci			hi->version = ATTO_VER_GET_DEV_INFO0;
116862306a36Sopenharmony_ci			break;
116962306a36Sopenharmony_ci		}
117062306a36Sopenharmony_ci
117162306a36Sopenharmony_ci		if (gdi->target_id >= ESAS2R_MAX_TARGETS) {
117262306a36Sopenharmony_ci			hi->status = ATTO_STS_INV_PARAM;
117362306a36Sopenharmony_ci			break;
117462306a36Sopenharmony_ci		}
117562306a36Sopenharmony_ci
117662306a36Sopenharmony_ci		t = a->targetdb + (u16)gdi->target_id;
117762306a36Sopenharmony_ci
117862306a36Sopenharmony_ci		/* update the target ID to the next one present. */
117962306a36Sopenharmony_ci
118062306a36Sopenharmony_ci		gdi->target_id =
118162306a36Sopenharmony_ci			esas2r_targ_db_find_next_present(a,
118262306a36Sopenharmony_ci							 (u16)gdi->target_id);
118362306a36Sopenharmony_ci
118462306a36Sopenharmony_ci		if (t->target_state != TS_PRESENT) {
118562306a36Sopenharmony_ci			hi->status = ATTO_STS_FAILED;
118662306a36Sopenharmony_ci			break;
118762306a36Sopenharmony_ci		}
118862306a36Sopenharmony_ci
118962306a36Sopenharmony_ci		hi->status = ATTO_STS_UNSUPPORTED;
119062306a36Sopenharmony_ci		break;
119162306a36Sopenharmony_ci	}
119262306a36Sopenharmony_ci
119362306a36Sopenharmony_ci	default:
119462306a36Sopenharmony_ci
119562306a36Sopenharmony_ci		hi->status = ATTO_STS_INV_FUNC;
119662306a36Sopenharmony_ci		break;
119762306a36Sopenharmony_ci	}
119862306a36Sopenharmony_ci
119962306a36Sopenharmony_ci	return false;
120062306a36Sopenharmony_ci}
120162306a36Sopenharmony_ci
120262306a36Sopenharmony_cistatic void hba_ioctl_done_callback(struct esas2r_adapter *a,
120362306a36Sopenharmony_ci				    struct esas2r_request *rq, void *context)
120462306a36Sopenharmony_ci{
120562306a36Sopenharmony_ci	struct atto_ioctl *ioctl_hba =
120662306a36Sopenharmony_ci		(struct atto_ioctl *)esas2r_buffered_ioctl;
120762306a36Sopenharmony_ci
120862306a36Sopenharmony_ci	esas2r_debug("hba_ioctl_done_callback %d", a->index);
120962306a36Sopenharmony_ci
121062306a36Sopenharmony_ci	if (ioctl_hba->function == ATTO_FUNC_GET_ADAP_INFO) {
121162306a36Sopenharmony_ci		struct atto_hba_get_adapter_info *gai =
121262306a36Sopenharmony_ci			&ioctl_hba->data.get_adap_info;
121362306a36Sopenharmony_ci
121462306a36Sopenharmony_ci		esas2r_debug("ATTO_FUNC_GET_ADAP_INFO");
121562306a36Sopenharmony_ci
121662306a36Sopenharmony_ci		gai->drvr_rev_major = ESAS2R_MAJOR_REV;
121762306a36Sopenharmony_ci		gai->drvr_rev_minor = ESAS2R_MINOR_REV;
121862306a36Sopenharmony_ci
121962306a36Sopenharmony_ci		strcpy(gai->drvr_rev_ascii, ESAS2R_VERSION_STR);
122062306a36Sopenharmony_ci		strcpy(gai->drvr_name, ESAS2R_DRVR_NAME);
122162306a36Sopenharmony_ci
122262306a36Sopenharmony_ci		gai->num_busses = 1;
122362306a36Sopenharmony_ci		gai->num_targsper_bus = ESAS2R_MAX_ID + 1;
122462306a36Sopenharmony_ci		gai->num_lunsper_targ = 1;
122562306a36Sopenharmony_ci	}
122662306a36Sopenharmony_ci}
122762306a36Sopenharmony_ci
122862306a36Sopenharmony_ciu8 handle_hba_ioctl(struct esas2r_adapter *a,
122962306a36Sopenharmony_ci		    struct atto_ioctl *ioctl_hba)
123062306a36Sopenharmony_ci{
123162306a36Sopenharmony_ci	struct esas2r_buffered_ioctl bi;
123262306a36Sopenharmony_ci
123362306a36Sopenharmony_ci	memset(&bi, 0, sizeof(bi));
123462306a36Sopenharmony_ci
123562306a36Sopenharmony_ci	bi.a = a;
123662306a36Sopenharmony_ci	bi.ioctl = ioctl_hba;
123762306a36Sopenharmony_ci	bi.length = sizeof(struct atto_ioctl) + ioctl_hba->data_length;
123862306a36Sopenharmony_ci	bi.callback = hba_ioctl_callback;
123962306a36Sopenharmony_ci	bi.context = NULL;
124062306a36Sopenharmony_ci	bi.done_callback = hba_ioctl_done_callback;
124162306a36Sopenharmony_ci	bi.done_context = NULL;
124262306a36Sopenharmony_ci	bi.offset = 0;
124362306a36Sopenharmony_ci
124462306a36Sopenharmony_ci	return handle_buffered_ioctl(&bi);
124562306a36Sopenharmony_ci}
124662306a36Sopenharmony_ci
124762306a36Sopenharmony_ci
124862306a36Sopenharmony_ciint esas2r_write_params(struct esas2r_adapter *a, struct esas2r_request *rq,
124962306a36Sopenharmony_ci			struct esas2r_sas_nvram *data)
125062306a36Sopenharmony_ci{
125162306a36Sopenharmony_ci	int result = 0;
125262306a36Sopenharmony_ci
125362306a36Sopenharmony_ci	a->nvram_command_done = 0;
125462306a36Sopenharmony_ci	rq->comp_cb = complete_nvr_req;
125562306a36Sopenharmony_ci
125662306a36Sopenharmony_ci	if (esas2r_nvram_write(a, rq, data)) {
125762306a36Sopenharmony_ci		/* now wait around for it to complete. */
125862306a36Sopenharmony_ci		while (!a->nvram_command_done)
125962306a36Sopenharmony_ci			wait_event_interruptible(a->nvram_waiter,
126062306a36Sopenharmony_ci						 a->nvram_command_done);
126162306a36Sopenharmony_ci		;
126262306a36Sopenharmony_ci
126362306a36Sopenharmony_ci		/* done, check the status. */
126462306a36Sopenharmony_ci		if (rq->req_stat == RS_SUCCESS)
126562306a36Sopenharmony_ci			result = 1;
126662306a36Sopenharmony_ci	}
126762306a36Sopenharmony_ci	return result;
126862306a36Sopenharmony_ci}
126962306a36Sopenharmony_ci
127062306a36Sopenharmony_ci
127162306a36Sopenharmony_ci/* This function only cares about ATTO-specific ioctls (atto_express_ioctl) */
127262306a36Sopenharmony_ciint esas2r_ioctl_handler(void *hostdata, unsigned int cmd, void __user *arg)
127362306a36Sopenharmony_ci{
127462306a36Sopenharmony_ci	struct atto_express_ioctl *ioctl = NULL;
127562306a36Sopenharmony_ci	struct esas2r_adapter *a;
127662306a36Sopenharmony_ci	struct esas2r_request *rq;
127762306a36Sopenharmony_ci	u16 code;
127862306a36Sopenharmony_ci	int err;
127962306a36Sopenharmony_ci
128062306a36Sopenharmony_ci	esas2r_log(ESAS2R_LOG_DEBG, "ioctl (%p, %x, %p)", hostdata, cmd, arg);
128162306a36Sopenharmony_ci
128262306a36Sopenharmony_ci	if ((arg == NULL)
128362306a36Sopenharmony_ci	    || (cmd < EXPRESS_IOCTL_MIN)
128462306a36Sopenharmony_ci	    || (cmd > EXPRESS_IOCTL_MAX))
128562306a36Sopenharmony_ci		return -ENOTSUPP;
128662306a36Sopenharmony_ci
128762306a36Sopenharmony_ci	ioctl = memdup_user(arg, sizeof(struct atto_express_ioctl));
128862306a36Sopenharmony_ci	if (IS_ERR(ioctl)) {
128962306a36Sopenharmony_ci		esas2r_log(ESAS2R_LOG_WARN,
129062306a36Sopenharmony_ci			   "ioctl_handler access_ok failed for cmd %u, address %p",
129162306a36Sopenharmony_ci			   cmd, arg);
129262306a36Sopenharmony_ci		return PTR_ERR(ioctl);
129362306a36Sopenharmony_ci	}
129462306a36Sopenharmony_ci
129562306a36Sopenharmony_ci	/* verify the signature */
129662306a36Sopenharmony_ci
129762306a36Sopenharmony_ci	if (memcmp(ioctl->header.signature,
129862306a36Sopenharmony_ci		   EXPRESS_IOCTL_SIGNATURE,
129962306a36Sopenharmony_ci		   EXPRESS_IOCTL_SIGNATURE_SIZE) != 0) {
130062306a36Sopenharmony_ci		esas2r_log(ESAS2R_LOG_WARN, "invalid signature");
130162306a36Sopenharmony_ci		kfree(ioctl);
130262306a36Sopenharmony_ci
130362306a36Sopenharmony_ci		return -ENOTSUPP;
130462306a36Sopenharmony_ci	}
130562306a36Sopenharmony_ci
130662306a36Sopenharmony_ci	/* assume success */
130762306a36Sopenharmony_ci
130862306a36Sopenharmony_ci	ioctl->header.return_code = IOCTL_SUCCESS;
130962306a36Sopenharmony_ci	err = 0;
131062306a36Sopenharmony_ci
131162306a36Sopenharmony_ci	/*
131262306a36Sopenharmony_ci	 * handle EXPRESS_IOCTL_GET_CHANNELS
131362306a36Sopenharmony_ci	 * without paying attention to channel
131462306a36Sopenharmony_ci	 */
131562306a36Sopenharmony_ci
131662306a36Sopenharmony_ci	if (cmd == EXPRESS_IOCTL_GET_CHANNELS) {
131762306a36Sopenharmony_ci		int i = 0, k = 0;
131862306a36Sopenharmony_ci
131962306a36Sopenharmony_ci		ioctl->data.chanlist.num_channels = 0;
132062306a36Sopenharmony_ci
132162306a36Sopenharmony_ci		while (i < MAX_ADAPTERS) {
132262306a36Sopenharmony_ci			if (esas2r_adapters[i]) {
132362306a36Sopenharmony_ci				ioctl->data.chanlist.num_channels++;
132462306a36Sopenharmony_ci				ioctl->data.chanlist.channel[k] = i;
132562306a36Sopenharmony_ci				k++;
132662306a36Sopenharmony_ci			}
132762306a36Sopenharmony_ci			i++;
132862306a36Sopenharmony_ci		}
132962306a36Sopenharmony_ci
133062306a36Sopenharmony_ci		goto ioctl_done;
133162306a36Sopenharmony_ci	}
133262306a36Sopenharmony_ci
133362306a36Sopenharmony_ci	/* get the channel */
133462306a36Sopenharmony_ci
133562306a36Sopenharmony_ci	if (ioctl->header.channel == 0xFF) {
133662306a36Sopenharmony_ci		a = (struct esas2r_adapter *)hostdata;
133762306a36Sopenharmony_ci	} else {
133862306a36Sopenharmony_ci		if (ioctl->header.channel >= MAX_ADAPTERS ||
133962306a36Sopenharmony_ci			esas2r_adapters[ioctl->header.channel] == NULL) {
134062306a36Sopenharmony_ci			ioctl->header.return_code = IOCTL_BAD_CHANNEL;
134162306a36Sopenharmony_ci			esas2r_log(ESAS2R_LOG_WARN, "bad channel value");
134262306a36Sopenharmony_ci			kfree(ioctl);
134362306a36Sopenharmony_ci
134462306a36Sopenharmony_ci			return -ENOTSUPP;
134562306a36Sopenharmony_ci		}
134662306a36Sopenharmony_ci		a = esas2r_adapters[ioctl->header.channel];
134762306a36Sopenharmony_ci	}
134862306a36Sopenharmony_ci
134962306a36Sopenharmony_ci	switch (cmd) {
135062306a36Sopenharmony_ci	case EXPRESS_IOCTL_RW_FIRMWARE:
135162306a36Sopenharmony_ci
135262306a36Sopenharmony_ci		if (ioctl->data.fwrw.img_type == FW_IMG_FM_API) {
135362306a36Sopenharmony_ci			err = esas2r_write_fw(a,
135462306a36Sopenharmony_ci					      (char *)ioctl->data.fwrw.image,
135562306a36Sopenharmony_ci					      0,
135662306a36Sopenharmony_ci					      sizeof(struct
135762306a36Sopenharmony_ci						     atto_express_ioctl));
135862306a36Sopenharmony_ci
135962306a36Sopenharmony_ci			if (err >= 0) {
136062306a36Sopenharmony_ci				err = esas2r_read_fw(a,
136162306a36Sopenharmony_ci						     (char *)ioctl->data.fwrw.
136262306a36Sopenharmony_ci						     image,
136362306a36Sopenharmony_ci						     0,
136462306a36Sopenharmony_ci						     sizeof(struct
136562306a36Sopenharmony_ci							    atto_express_ioctl));
136662306a36Sopenharmony_ci			}
136762306a36Sopenharmony_ci		} else if (ioctl->data.fwrw.img_type == FW_IMG_FS_API) {
136862306a36Sopenharmony_ci			err = esas2r_write_fs(a,
136962306a36Sopenharmony_ci					      (char *)ioctl->data.fwrw.image,
137062306a36Sopenharmony_ci					      0,
137162306a36Sopenharmony_ci					      sizeof(struct
137262306a36Sopenharmony_ci						     atto_express_ioctl));
137362306a36Sopenharmony_ci
137462306a36Sopenharmony_ci			if (err >= 0) {
137562306a36Sopenharmony_ci				err = esas2r_read_fs(a,
137662306a36Sopenharmony_ci						     (char *)ioctl->data.fwrw.
137762306a36Sopenharmony_ci						     image,
137862306a36Sopenharmony_ci						     0,
137962306a36Sopenharmony_ci						     sizeof(struct
138062306a36Sopenharmony_ci							    atto_express_ioctl));
138162306a36Sopenharmony_ci			}
138262306a36Sopenharmony_ci		} else {
138362306a36Sopenharmony_ci			ioctl->header.return_code = IOCTL_BAD_FLASH_IMGTYPE;
138462306a36Sopenharmony_ci		}
138562306a36Sopenharmony_ci
138662306a36Sopenharmony_ci		break;
138762306a36Sopenharmony_ci
138862306a36Sopenharmony_ci	case EXPRESS_IOCTL_READ_PARAMS:
138962306a36Sopenharmony_ci
139062306a36Sopenharmony_ci		memcpy(ioctl->data.prw.data_buffer, a->nvram,
139162306a36Sopenharmony_ci		       sizeof(struct esas2r_sas_nvram));
139262306a36Sopenharmony_ci		ioctl->data.prw.code = 1;
139362306a36Sopenharmony_ci		break;
139462306a36Sopenharmony_ci
139562306a36Sopenharmony_ci	case EXPRESS_IOCTL_WRITE_PARAMS:
139662306a36Sopenharmony_ci
139762306a36Sopenharmony_ci		rq = esas2r_alloc_request(a);
139862306a36Sopenharmony_ci		if (rq == NULL) {
139962306a36Sopenharmony_ci			kfree(ioctl);
140062306a36Sopenharmony_ci			esas2r_log(ESAS2R_LOG_WARN,
140162306a36Sopenharmony_ci			   "could not allocate an internal request");
140262306a36Sopenharmony_ci			return -ENOMEM;
140362306a36Sopenharmony_ci		}
140462306a36Sopenharmony_ci
140562306a36Sopenharmony_ci		code = esas2r_write_params(a, rq,
140662306a36Sopenharmony_ci					   (struct esas2r_sas_nvram *)ioctl->data.prw.data_buffer);
140762306a36Sopenharmony_ci		ioctl->data.prw.code = code;
140862306a36Sopenharmony_ci
140962306a36Sopenharmony_ci		esas2r_free_request(a, rq);
141062306a36Sopenharmony_ci
141162306a36Sopenharmony_ci		break;
141262306a36Sopenharmony_ci
141362306a36Sopenharmony_ci	case EXPRESS_IOCTL_DEFAULT_PARAMS:
141462306a36Sopenharmony_ci
141562306a36Sopenharmony_ci		esas2r_nvram_get_defaults(a,
141662306a36Sopenharmony_ci					  (struct esas2r_sas_nvram *)ioctl->data.prw.data_buffer);
141762306a36Sopenharmony_ci		ioctl->data.prw.code = 1;
141862306a36Sopenharmony_ci		break;
141962306a36Sopenharmony_ci
142062306a36Sopenharmony_ci	case EXPRESS_IOCTL_CHAN_INFO:
142162306a36Sopenharmony_ci
142262306a36Sopenharmony_ci		ioctl->data.chaninfo.major_rev = ESAS2R_MAJOR_REV;
142362306a36Sopenharmony_ci		ioctl->data.chaninfo.minor_rev = ESAS2R_MINOR_REV;
142462306a36Sopenharmony_ci		ioctl->data.chaninfo.IRQ = a->pcid->irq;
142562306a36Sopenharmony_ci		ioctl->data.chaninfo.device_id = a->pcid->device;
142662306a36Sopenharmony_ci		ioctl->data.chaninfo.vendor_id = a->pcid->vendor;
142762306a36Sopenharmony_ci		ioctl->data.chaninfo.ven_dev_id = a->pcid->subsystem_device;
142862306a36Sopenharmony_ci		ioctl->data.chaninfo.revision_id = a->pcid->revision;
142962306a36Sopenharmony_ci		ioctl->data.chaninfo.pci_bus = a->pcid->bus->number;
143062306a36Sopenharmony_ci		ioctl->data.chaninfo.pci_dev_func = a->pcid->devfn;
143162306a36Sopenharmony_ci		ioctl->data.chaninfo.core_rev = 0;
143262306a36Sopenharmony_ci		ioctl->data.chaninfo.host_no = a->host->host_no;
143362306a36Sopenharmony_ci		ioctl->data.chaninfo.hbaapi_rev = 0;
143462306a36Sopenharmony_ci		break;
143562306a36Sopenharmony_ci
143662306a36Sopenharmony_ci	case EXPRESS_IOCTL_SMP:
143762306a36Sopenharmony_ci		ioctl->header.return_code = handle_smp_ioctl(a,
143862306a36Sopenharmony_ci							     &ioctl->data.
143962306a36Sopenharmony_ci							     ioctl_smp);
144062306a36Sopenharmony_ci		break;
144162306a36Sopenharmony_ci
144262306a36Sopenharmony_ci	case EXPRESS_CSMI:
144362306a36Sopenharmony_ci		ioctl->header.return_code =
144462306a36Sopenharmony_ci			handle_csmi_ioctl(a, &ioctl->data.csmi);
144562306a36Sopenharmony_ci		break;
144662306a36Sopenharmony_ci
144762306a36Sopenharmony_ci	case EXPRESS_IOCTL_HBA:
144862306a36Sopenharmony_ci		ioctl->header.return_code = handle_hba_ioctl(a,
144962306a36Sopenharmony_ci							     &ioctl->data.
145062306a36Sopenharmony_ci							     ioctl_hba);
145162306a36Sopenharmony_ci		break;
145262306a36Sopenharmony_ci
145362306a36Sopenharmony_ci	case EXPRESS_IOCTL_VDA:
145462306a36Sopenharmony_ci		err = esas2r_write_vda(a,
145562306a36Sopenharmony_ci				       (char *)&ioctl->data.ioctl_vda,
145662306a36Sopenharmony_ci				       0,
145762306a36Sopenharmony_ci				       sizeof(struct atto_ioctl_vda) +
145862306a36Sopenharmony_ci				       ioctl->data.ioctl_vda.data_length);
145962306a36Sopenharmony_ci
146062306a36Sopenharmony_ci		if (err >= 0) {
146162306a36Sopenharmony_ci			err = esas2r_read_vda(a,
146262306a36Sopenharmony_ci					      (char *)&ioctl->data.ioctl_vda,
146362306a36Sopenharmony_ci					      0,
146462306a36Sopenharmony_ci					      sizeof(struct atto_ioctl_vda) +
146562306a36Sopenharmony_ci					      ioctl->data.ioctl_vda.data_length);
146662306a36Sopenharmony_ci		}
146762306a36Sopenharmony_ci
146862306a36Sopenharmony_ci
146962306a36Sopenharmony_ci
147062306a36Sopenharmony_ci
147162306a36Sopenharmony_ci		break;
147262306a36Sopenharmony_ci
147362306a36Sopenharmony_ci	case EXPRESS_IOCTL_GET_MOD_INFO:
147462306a36Sopenharmony_ci
147562306a36Sopenharmony_ci		ioctl->data.modinfo.adapter = a;
147662306a36Sopenharmony_ci		ioctl->data.modinfo.pci_dev = a->pcid;
147762306a36Sopenharmony_ci		ioctl->data.modinfo.scsi_host = a->host;
147862306a36Sopenharmony_ci		ioctl->data.modinfo.host_no = a->host->host_no;
147962306a36Sopenharmony_ci
148062306a36Sopenharmony_ci		break;
148162306a36Sopenharmony_ci
148262306a36Sopenharmony_ci	default:
148362306a36Sopenharmony_ci		esas2r_debug("esas2r_ioctl invalid cmd %p!", cmd);
148462306a36Sopenharmony_ci		ioctl->header.return_code = IOCTL_ERR_INVCMD;
148562306a36Sopenharmony_ci	}
148662306a36Sopenharmony_ci
148762306a36Sopenharmony_ciioctl_done:
148862306a36Sopenharmony_ci
148962306a36Sopenharmony_ci	if (err < 0) {
149062306a36Sopenharmony_ci		esas2r_log(ESAS2R_LOG_WARN, "err %d on ioctl cmd %u", err,
149162306a36Sopenharmony_ci			   cmd);
149262306a36Sopenharmony_ci
149362306a36Sopenharmony_ci		switch (err) {
149462306a36Sopenharmony_ci		case -ENOMEM:
149562306a36Sopenharmony_ci		case -EBUSY:
149662306a36Sopenharmony_ci			ioctl->header.return_code = IOCTL_OUT_OF_RESOURCES;
149762306a36Sopenharmony_ci			break;
149862306a36Sopenharmony_ci
149962306a36Sopenharmony_ci		case -ENOSYS:
150062306a36Sopenharmony_ci		case -EINVAL:
150162306a36Sopenharmony_ci			ioctl->header.return_code = IOCTL_INVALID_PARAM;
150262306a36Sopenharmony_ci			break;
150362306a36Sopenharmony_ci
150462306a36Sopenharmony_ci		default:
150562306a36Sopenharmony_ci			ioctl->header.return_code = IOCTL_GENERAL_ERROR;
150662306a36Sopenharmony_ci			break;
150762306a36Sopenharmony_ci		}
150862306a36Sopenharmony_ci
150962306a36Sopenharmony_ci	}
151062306a36Sopenharmony_ci
151162306a36Sopenharmony_ci	/* Always copy the buffer back, if only to pick up the status */
151262306a36Sopenharmony_ci	err = copy_to_user(arg, ioctl, sizeof(struct atto_express_ioctl));
151362306a36Sopenharmony_ci	if (err != 0) {
151462306a36Sopenharmony_ci		esas2r_log(ESAS2R_LOG_WARN,
151562306a36Sopenharmony_ci			   "ioctl_handler copy_to_user didn't copy everything (err %d, cmd %u)",
151662306a36Sopenharmony_ci			   err, cmd);
151762306a36Sopenharmony_ci		kfree(ioctl);
151862306a36Sopenharmony_ci
151962306a36Sopenharmony_ci		return -EFAULT;
152062306a36Sopenharmony_ci	}
152162306a36Sopenharmony_ci
152262306a36Sopenharmony_ci	kfree(ioctl);
152362306a36Sopenharmony_ci
152462306a36Sopenharmony_ci	return 0;
152562306a36Sopenharmony_ci}
152662306a36Sopenharmony_ci
152762306a36Sopenharmony_ciint esas2r_ioctl(struct scsi_device *sd, unsigned int cmd, void __user *arg)
152862306a36Sopenharmony_ci{
152962306a36Sopenharmony_ci	return esas2r_ioctl_handler(sd->host->hostdata, cmd, arg);
153062306a36Sopenharmony_ci}
153162306a36Sopenharmony_ci
153262306a36Sopenharmony_cistatic void free_fw_buffers(struct esas2r_adapter *a)
153362306a36Sopenharmony_ci{
153462306a36Sopenharmony_ci	if (a->firmware.data) {
153562306a36Sopenharmony_ci		dma_free_coherent(&a->pcid->dev,
153662306a36Sopenharmony_ci				  (size_t)a->firmware.orig_len,
153762306a36Sopenharmony_ci				  a->firmware.data,
153862306a36Sopenharmony_ci				  (dma_addr_t)a->firmware.phys);
153962306a36Sopenharmony_ci
154062306a36Sopenharmony_ci		a->firmware.data = NULL;
154162306a36Sopenharmony_ci	}
154262306a36Sopenharmony_ci}
154362306a36Sopenharmony_ci
154462306a36Sopenharmony_cistatic int allocate_fw_buffers(struct esas2r_adapter *a, u32 length)
154562306a36Sopenharmony_ci{
154662306a36Sopenharmony_ci	free_fw_buffers(a);
154762306a36Sopenharmony_ci
154862306a36Sopenharmony_ci	a->firmware.orig_len = length;
154962306a36Sopenharmony_ci
155062306a36Sopenharmony_ci	a->firmware.data = dma_alloc_coherent(&a->pcid->dev,
155162306a36Sopenharmony_ci					      (size_t)length,
155262306a36Sopenharmony_ci					      (dma_addr_t *)&a->firmware.phys,
155362306a36Sopenharmony_ci					      GFP_KERNEL);
155462306a36Sopenharmony_ci
155562306a36Sopenharmony_ci	if (!a->firmware.data) {
155662306a36Sopenharmony_ci		esas2r_debug("buffer alloc failed!");
155762306a36Sopenharmony_ci		return 0;
155862306a36Sopenharmony_ci	}
155962306a36Sopenharmony_ci
156062306a36Sopenharmony_ci	return 1;
156162306a36Sopenharmony_ci}
156262306a36Sopenharmony_ci
156362306a36Sopenharmony_ci/* Handle a call to read firmware. */
156462306a36Sopenharmony_ciint esas2r_read_fw(struct esas2r_adapter *a, char *buf, long off, int count)
156562306a36Sopenharmony_ci{
156662306a36Sopenharmony_ci	esas2r_trace_enter();
156762306a36Sopenharmony_ci	/* if the cached header is a status, simply copy it over and return. */
156862306a36Sopenharmony_ci	if (a->firmware.state == FW_STATUS_ST) {
156962306a36Sopenharmony_ci		int size = min_t(int, count, sizeof(a->firmware.header));
157062306a36Sopenharmony_ci		esas2r_trace_exit();
157162306a36Sopenharmony_ci		memcpy(buf, &a->firmware.header, size);
157262306a36Sopenharmony_ci		esas2r_debug("esas2r_read_fw: STATUS size %d", size);
157362306a36Sopenharmony_ci		return size;
157462306a36Sopenharmony_ci	}
157562306a36Sopenharmony_ci
157662306a36Sopenharmony_ci	/*
157762306a36Sopenharmony_ci	 * if the cached header is a command, do it if at
157862306a36Sopenharmony_ci	 * offset 0, otherwise copy the pieces.
157962306a36Sopenharmony_ci	 */
158062306a36Sopenharmony_ci
158162306a36Sopenharmony_ci	if (a->firmware.state == FW_COMMAND_ST) {
158262306a36Sopenharmony_ci		u32 length = a->firmware.header.length;
158362306a36Sopenharmony_ci		esas2r_trace_exit();
158462306a36Sopenharmony_ci
158562306a36Sopenharmony_ci		esas2r_debug("esas2r_read_fw: COMMAND length %d off %d",
158662306a36Sopenharmony_ci			     length,
158762306a36Sopenharmony_ci			     off);
158862306a36Sopenharmony_ci
158962306a36Sopenharmony_ci		if (off == 0) {
159062306a36Sopenharmony_ci			if (a->firmware.header.action == FI_ACT_UP) {
159162306a36Sopenharmony_ci				if (!allocate_fw_buffers(a, length))
159262306a36Sopenharmony_ci					return -ENOMEM;
159362306a36Sopenharmony_ci
159462306a36Sopenharmony_ci
159562306a36Sopenharmony_ci				/* copy header over */
159662306a36Sopenharmony_ci
159762306a36Sopenharmony_ci				memcpy(a->firmware.data,
159862306a36Sopenharmony_ci				       &a->firmware.header,
159962306a36Sopenharmony_ci				       sizeof(a->firmware.header));
160062306a36Sopenharmony_ci
160162306a36Sopenharmony_ci				do_fm_api(a,
160262306a36Sopenharmony_ci					  (struct esas2r_flash_img *)a->firmware.data);
160362306a36Sopenharmony_ci			} else if (a->firmware.header.action == FI_ACT_UPSZ) {
160462306a36Sopenharmony_ci				int size =
160562306a36Sopenharmony_ci					min((int)count,
160662306a36Sopenharmony_ci					    (int)sizeof(a->firmware.header));
160762306a36Sopenharmony_ci				do_fm_api(a, &a->firmware.header);
160862306a36Sopenharmony_ci				memcpy(buf, &a->firmware.header, size);
160962306a36Sopenharmony_ci				esas2r_debug("FI_ACT_UPSZ size %d", size);
161062306a36Sopenharmony_ci				return size;
161162306a36Sopenharmony_ci			} else {
161262306a36Sopenharmony_ci				esas2r_debug("invalid action %d",
161362306a36Sopenharmony_ci					     a->firmware.header.action);
161462306a36Sopenharmony_ci				return -ENOSYS;
161562306a36Sopenharmony_ci			}
161662306a36Sopenharmony_ci		}
161762306a36Sopenharmony_ci
161862306a36Sopenharmony_ci		if (count + off > length)
161962306a36Sopenharmony_ci			count = length - off;
162062306a36Sopenharmony_ci
162162306a36Sopenharmony_ci		if (count < 0)
162262306a36Sopenharmony_ci			return 0;
162362306a36Sopenharmony_ci
162462306a36Sopenharmony_ci		if (!a->firmware.data) {
162562306a36Sopenharmony_ci			esas2r_debug(
162662306a36Sopenharmony_ci				"read: nonzero offset but no buffer available!");
162762306a36Sopenharmony_ci			return -ENOMEM;
162862306a36Sopenharmony_ci		}
162962306a36Sopenharmony_ci
163062306a36Sopenharmony_ci		esas2r_debug("esas2r_read_fw: off %d count %d length %d ", off,
163162306a36Sopenharmony_ci			     count,
163262306a36Sopenharmony_ci			     length);
163362306a36Sopenharmony_ci
163462306a36Sopenharmony_ci		memcpy(buf, &a->firmware.data[off], count);
163562306a36Sopenharmony_ci
163662306a36Sopenharmony_ci		/* when done, release the buffer */
163762306a36Sopenharmony_ci
163862306a36Sopenharmony_ci		if (length <= off + count) {
163962306a36Sopenharmony_ci			esas2r_debug("esas2r_read_fw: freeing buffer!");
164062306a36Sopenharmony_ci
164162306a36Sopenharmony_ci			free_fw_buffers(a);
164262306a36Sopenharmony_ci		}
164362306a36Sopenharmony_ci
164462306a36Sopenharmony_ci		return count;
164562306a36Sopenharmony_ci	}
164662306a36Sopenharmony_ci
164762306a36Sopenharmony_ci	esas2r_trace_exit();
164862306a36Sopenharmony_ci	esas2r_debug("esas2r_read_fw: invalid firmware state %d",
164962306a36Sopenharmony_ci		     a->firmware.state);
165062306a36Sopenharmony_ci
165162306a36Sopenharmony_ci	return -EINVAL;
165262306a36Sopenharmony_ci}
165362306a36Sopenharmony_ci
165462306a36Sopenharmony_ci/* Handle a call to write firmware. */
165562306a36Sopenharmony_ciint esas2r_write_fw(struct esas2r_adapter *a, const char *buf, long off,
165662306a36Sopenharmony_ci		    int count)
165762306a36Sopenharmony_ci{
165862306a36Sopenharmony_ci	u32 length;
165962306a36Sopenharmony_ci
166062306a36Sopenharmony_ci	if (off == 0) {
166162306a36Sopenharmony_ci		struct esas2r_flash_img *header =
166262306a36Sopenharmony_ci			(struct esas2r_flash_img *)buf;
166362306a36Sopenharmony_ci
166462306a36Sopenharmony_ci		/* assume version 0 flash image */
166562306a36Sopenharmony_ci
166662306a36Sopenharmony_ci		int min_size = sizeof(struct esas2r_flash_img_v0);
166762306a36Sopenharmony_ci
166862306a36Sopenharmony_ci		a->firmware.state = FW_INVALID_ST;
166962306a36Sopenharmony_ci
167062306a36Sopenharmony_ci		/* validate the version field first */
167162306a36Sopenharmony_ci
167262306a36Sopenharmony_ci		if (count < 4
167362306a36Sopenharmony_ci		    ||  header->fi_version > FI_VERSION_1) {
167462306a36Sopenharmony_ci			esas2r_debug(
167562306a36Sopenharmony_ci				"esas2r_write_fw: short header or invalid version");
167662306a36Sopenharmony_ci			return -EINVAL;
167762306a36Sopenharmony_ci		}
167862306a36Sopenharmony_ci
167962306a36Sopenharmony_ci		/* See if its a version 1 flash image */
168062306a36Sopenharmony_ci
168162306a36Sopenharmony_ci		if (header->fi_version == FI_VERSION_1)
168262306a36Sopenharmony_ci			min_size = sizeof(struct esas2r_flash_img);
168362306a36Sopenharmony_ci
168462306a36Sopenharmony_ci		/* If this is the start, the header must be full and valid. */
168562306a36Sopenharmony_ci		if (count < min_size) {
168662306a36Sopenharmony_ci			esas2r_debug("esas2r_write_fw: short header, aborting");
168762306a36Sopenharmony_ci			return -EINVAL;
168862306a36Sopenharmony_ci		}
168962306a36Sopenharmony_ci
169062306a36Sopenharmony_ci		/* Make sure the size is reasonable. */
169162306a36Sopenharmony_ci		length = header->length;
169262306a36Sopenharmony_ci
169362306a36Sopenharmony_ci		if (length > 1024 * 1024) {
169462306a36Sopenharmony_ci			esas2r_debug(
169562306a36Sopenharmony_ci				"esas2r_write_fw: hosed, length %d  fi_version %d",
169662306a36Sopenharmony_ci				length, header->fi_version);
169762306a36Sopenharmony_ci			return -EINVAL;
169862306a36Sopenharmony_ci		}
169962306a36Sopenharmony_ci
170062306a36Sopenharmony_ci		/*
170162306a36Sopenharmony_ci		 * If this is a write command, allocate memory because
170262306a36Sopenharmony_ci		 * we have to cache everything. otherwise, just cache
170362306a36Sopenharmony_ci		 * the header, because the read op will do the command.
170462306a36Sopenharmony_ci		 */
170562306a36Sopenharmony_ci
170662306a36Sopenharmony_ci		if (header->action == FI_ACT_DOWN) {
170762306a36Sopenharmony_ci			if (!allocate_fw_buffers(a, length))
170862306a36Sopenharmony_ci				return -ENOMEM;
170962306a36Sopenharmony_ci
171062306a36Sopenharmony_ci			/*
171162306a36Sopenharmony_ci			 * Store the command, so there is context on subsequent
171262306a36Sopenharmony_ci			 * calls.
171362306a36Sopenharmony_ci			 */
171462306a36Sopenharmony_ci			memcpy(&a->firmware.header,
171562306a36Sopenharmony_ci			       buf,
171662306a36Sopenharmony_ci			       sizeof(*header));
171762306a36Sopenharmony_ci		} else if (header->action == FI_ACT_UP
171862306a36Sopenharmony_ci			   ||  header->action == FI_ACT_UPSZ) {
171962306a36Sopenharmony_ci			/* Save the command, result will be picked up on read */
172062306a36Sopenharmony_ci			memcpy(&a->firmware.header,
172162306a36Sopenharmony_ci			       buf,
172262306a36Sopenharmony_ci			       sizeof(*header));
172362306a36Sopenharmony_ci
172462306a36Sopenharmony_ci			a->firmware.state = FW_COMMAND_ST;
172562306a36Sopenharmony_ci
172662306a36Sopenharmony_ci			esas2r_debug(
172762306a36Sopenharmony_ci				"esas2r_write_fw: COMMAND, count %d, action %d ",
172862306a36Sopenharmony_ci				count, header->action);
172962306a36Sopenharmony_ci
173062306a36Sopenharmony_ci			/*
173162306a36Sopenharmony_ci			 * Pretend we took the whole buffer,
173262306a36Sopenharmony_ci			 * so we don't get bothered again.
173362306a36Sopenharmony_ci			 */
173462306a36Sopenharmony_ci
173562306a36Sopenharmony_ci			return count;
173662306a36Sopenharmony_ci		} else {
173762306a36Sopenharmony_ci			esas2r_debug("esas2r_write_fw: invalid action %d ",
173862306a36Sopenharmony_ci				     a->firmware.header.action);
173962306a36Sopenharmony_ci			return -ENOSYS;
174062306a36Sopenharmony_ci		}
174162306a36Sopenharmony_ci	} else {
174262306a36Sopenharmony_ci		length = a->firmware.header.length;
174362306a36Sopenharmony_ci	}
174462306a36Sopenharmony_ci
174562306a36Sopenharmony_ci	/*
174662306a36Sopenharmony_ci	 * We only get here on a download command, regardless of offset.
174762306a36Sopenharmony_ci	 * the chunks written by the system need to be cached, and when
174862306a36Sopenharmony_ci	 * the final one arrives, issue the fmapi command.
174962306a36Sopenharmony_ci	 */
175062306a36Sopenharmony_ci
175162306a36Sopenharmony_ci	if (off + count > length)
175262306a36Sopenharmony_ci		count = length - off;
175362306a36Sopenharmony_ci
175462306a36Sopenharmony_ci	if (count > 0) {
175562306a36Sopenharmony_ci		esas2r_debug("esas2r_write_fw: off %d count %d length %d", off,
175662306a36Sopenharmony_ci			     count,
175762306a36Sopenharmony_ci			     length);
175862306a36Sopenharmony_ci
175962306a36Sopenharmony_ci		/*
176062306a36Sopenharmony_ci		 * On a full upload, the system tries sending the whole buffer.
176162306a36Sopenharmony_ci		 * there's nothing to do with it, so just drop it here, before
176262306a36Sopenharmony_ci		 * trying to copy over into unallocated memory!
176362306a36Sopenharmony_ci		 */
176462306a36Sopenharmony_ci		if (a->firmware.header.action == FI_ACT_UP)
176562306a36Sopenharmony_ci			return count;
176662306a36Sopenharmony_ci
176762306a36Sopenharmony_ci		if (!a->firmware.data) {
176862306a36Sopenharmony_ci			esas2r_debug(
176962306a36Sopenharmony_ci				"write: nonzero offset but no buffer available!");
177062306a36Sopenharmony_ci			return -ENOMEM;
177162306a36Sopenharmony_ci		}
177262306a36Sopenharmony_ci
177362306a36Sopenharmony_ci		memcpy(&a->firmware.data[off], buf, count);
177462306a36Sopenharmony_ci
177562306a36Sopenharmony_ci		if (length == off + count) {
177662306a36Sopenharmony_ci			do_fm_api(a,
177762306a36Sopenharmony_ci				  (struct esas2r_flash_img *)a->firmware.data);
177862306a36Sopenharmony_ci
177962306a36Sopenharmony_ci			/*
178062306a36Sopenharmony_ci			 * Now copy the header result to be picked up by the
178162306a36Sopenharmony_ci			 * next read
178262306a36Sopenharmony_ci			 */
178362306a36Sopenharmony_ci			memcpy(&a->firmware.header,
178462306a36Sopenharmony_ci			       a->firmware.data,
178562306a36Sopenharmony_ci			       sizeof(a->firmware.header));
178662306a36Sopenharmony_ci
178762306a36Sopenharmony_ci			a->firmware.state = FW_STATUS_ST;
178862306a36Sopenharmony_ci
178962306a36Sopenharmony_ci			esas2r_debug("write completed");
179062306a36Sopenharmony_ci
179162306a36Sopenharmony_ci			/*
179262306a36Sopenharmony_ci			 * Since the system has the data buffered, the only way
179362306a36Sopenharmony_ci			 * this can leak is if a root user writes a program
179462306a36Sopenharmony_ci			 * that writes a shorter buffer than it claims, and the
179562306a36Sopenharmony_ci			 * copyin fails.
179662306a36Sopenharmony_ci			 */
179762306a36Sopenharmony_ci			free_fw_buffers(a);
179862306a36Sopenharmony_ci		}
179962306a36Sopenharmony_ci	}
180062306a36Sopenharmony_ci
180162306a36Sopenharmony_ci	return count;
180262306a36Sopenharmony_ci}
180362306a36Sopenharmony_ci
180462306a36Sopenharmony_ci/* Callback for the completion of a VDA request. */
180562306a36Sopenharmony_cistatic void vda_complete_req(struct esas2r_adapter *a,
180662306a36Sopenharmony_ci			     struct esas2r_request *rq)
180762306a36Sopenharmony_ci{
180862306a36Sopenharmony_ci	a->vda_command_done = 1;
180962306a36Sopenharmony_ci	wake_up_interruptible(&a->vda_waiter);
181062306a36Sopenharmony_ci}
181162306a36Sopenharmony_ci
181262306a36Sopenharmony_ci/* Scatter/gather callback for VDA requests */
181362306a36Sopenharmony_cistatic u32 get_physaddr_vda(struct esas2r_sg_context *sgc, u64 *addr)
181462306a36Sopenharmony_ci{
181562306a36Sopenharmony_ci	struct esas2r_adapter *a = (struct esas2r_adapter *)sgc->adapter;
181662306a36Sopenharmony_ci	int offset = (u8 *)sgc->cur_offset - (u8 *)a->vda_buffer;
181762306a36Sopenharmony_ci
181862306a36Sopenharmony_ci	(*addr) = a->ppvda_buffer + offset;
181962306a36Sopenharmony_ci	return VDA_MAX_BUFFER_SIZE - offset;
182062306a36Sopenharmony_ci}
182162306a36Sopenharmony_ci
182262306a36Sopenharmony_ci/* Handle a call to read a VDA command. */
182362306a36Sopenharmony_ciint esas2r_read_vda(struct esas2r_adapter *a, char *buf, long off, int count)
182462306a36Sopenharmony_ci{
182562306a36Sopenharmony_ci	if (!a->vda_buffer)
182662306a36Sopenharmony_ci		return -ENOMEM;
182762306a36Sopenharmony_ci
182862306a36Sopenharmony_ci	if (off == 0) {
182962306a36Sopenharmony_ci		struct esas2r_request *rq;
183062306a36Sopenharmony_ci		struct atto_ioctl_vda *vi =
183162306a36Sopenharmony_ci			(struct atto_ioctl_vda *)a->vda_buffer;
183262306a36Sopenharmony_ci		struct esas2r_sg_context sgc;
183362306a36Sopenharmony_ci		bool wait_for_completion;
183462306a36Sopenharmony_ci
183562306a36Sopenharmony_ci		/*
183662306a36Sopenharmony_ci		 * Presumeably, someone has already written to the vda_buffer,
183762306a36Sopenharmony_ci		 * and now they are reading the node the response, so now we
183862306a36Sopenharmony_ci		 * will actually issue the request to the chip and reply.
183962306a36Sopenharmony_ci		 */
184062306a36Sopenharmony_ci
184162306a36Sopenharmony_ci		/* allocate a request */
184262306a36Sopenharmony_ci		rq = esas2r_alloc_request(a);
184362306a36Sopenharmony_ci		if (rq == NULL) {
184462306a36Sopenharmony_ci			esas2r_debug("esas2r_read_vda: out of requests");
184562306a36Sopenharmony_ci			return -EBUSY;
184662306a36Sopenharmony_ci		}
184762306a36Sopenharmony_ci
184862306a36Sopenharmony_ci		rq->comp_cb = vda_complete_req;
184962306a36Sopenharmony_ci
185062306a36Sopenharmony_ci		sgc.first_req = rq;
185162306a36Sopenharmony_ci		sgc.adapter = a;
185262306a36Sopenharmony_ci		sgc.cur_offset = a->vda_buffer + VDA_BUFFER_HEADER_SZ;
185362306a36Sopenharmony_ci		sgc.get_phys_addr = (PGETPHYSADDR)get_physaddr_vda;
185462306a36Sopenharmony_ci
185562306a36Sopenharmony_ci		a->vda_command_done = 0;
185662306a36Sopenharmony_ci
185762306a36Sopenharmony_ci		wait_for_completion =
185862306a36Sopenharmony_ci			esas2r_process_vda_ioctl(a, vi, rq, &sgc);
185962306a36Sopenharmony_ci
186062306a36Sopenharmony_ci		if (wait_for_completion) {
186162306a36Sopenharmony_ci			/* now wait around for it to complete. */
186262306a36Sopenharmony_ci
186362306a36Sopenharmony_ci			while (!a->vda_command_done)
186462306a36Sopenharmony_ci				wait_event_interruptible(a->vda_waiter,
186562306a36Sopenharmony_ci							 a->vda_command_done);
186662306a36Sopenharmony_ci		}
186762306a36Sopenharmony_ci
186862306a36Sopenharmony_ci		esas2r_free_request(a, (struct esas2r_request *)rq);
186962306a36Sopenharmony_ci	}
187062306a36Sopenharmony_ci
187162306a36Sopenharmony_ci	if (off > VDA_MAX_BUFFER_SIZE)
187262306a36Sopenharmony_ci		return 0;
187362306a36Sopenharmony_ci
187462306a36Sopenharmony_ci	if (count + off > VDA_MAX_BUFFER_SIZE)
187562306a36Sopenharmony_ci		count = VDA_MAX_BUFFER_SIZE - off;
187662306a36Sopenharmony_ci
187762306a36Sopenharmony_ci	if (count < 0)
187862306a36Sopenharmony_ci		return 0;
187962306a36Sopenharmony_ci
188062306a36Sopenharmony_ci	memcpy(buf, a->vda_buffer + off, count);
188162306a36Sopenharmony_ci
188262306a36Sopenharmony_ci	return count;
188362306a36Sopenharmony_ci}
188462306a36Sopenharmony_ci
188562306a36Sopenharmony_ci/* Handle a call to write a VDA command. */
188662306a36Sopenharmony_ciint esas2r_write_vda(struct esas2r_adapter *a, const char *buf, long off,
188762306a36Sopenharmony_ci		     int count)
188862306a36Sopenharmony_ci{
188962306a36Sopenharmony_ci	/*
189062306a36Sopenharmony_ci	 * allocate memory for it, if not already done.  once allocated,
189162306a36Sopenharmony_ci	 * we will keep it around until the driver is unloaded.
189262306a36Sopenharmony_ci	 */
189362306a36Sopenharmony_ci
189462306a36Sopenharmony_ci	if (!a->vda_buffer) {
189562306a36Sopenharmony_ci		dma_addr_t dma_addr;
189662306a36Sopenharmony_ci		a->vda_buffer = dma_alloc_coherent(&a->pcid->dev,
189762306a36Sopenharmony_ci						   (size_t)
189862306a36Sopenharmony_ci						   VDA_MAX_BUFFER_SIZE,
189962306a36Sopenharmony_ci						   &dma_addr,
190062306a36Sopenharmony_ci						   GFP_KERNEL);
190162306a36Sopenharmony_ci
190262306a36Sopenharmony_ci		a->ppvda_buffer = dma_addr;
190362306a36Sopenharmony_ci	}
190462306a36Sopenharmony_ci
190562306a36Sopenharmony_ci	if (!a->vda_buffer)
190662306a36Sopenharmony_ci		return -ENOMEM;
190762306a36Sopenharmony_ci
190862306a36Sopenharmony_ci	if (off > VDA_MAX_BUFFER_SIZE)
190962306a36Sopenharmony_ci		return 0;
191062306a36Sopenharmony_ci
191162306a36Sopenharmony_ci	if (count + off > VDA_MAX_BUFFER_SIZE)
191262306a36Sopenharmony_ci		count = VDA_MAX_BUFFER_SIZE - off;
191362306a36Sopenharmony_ci
191462306a36Sopenharmony_ci	if (count < 1)
191562306a36Sopenharmony_ci		return 0;
191662306a36Sopenharmony_ci
191762306a36Sopenharmony_ci	memcpy(a->vda_buffer + off, buf, count);
191862306a36Sopenharmony_ci
191962306a36Sopenharmony_ci	return count;
192062306a36Sopenharmony_ci}
192162306a36Sopenharmony_ci
192262306a36Sopenharmony_ci/* Callback for the completion of an FS_API request.*/
192362306a36Sopenharmony_cistatic void fs_api_complete_req(struct esas2r_adapter *a,
192462306a36Sopenharmony_ci				struct esas2r_request *rq)
192562306a36Sopenharmony_ci{
192662306a36Sopenharmony_ci	a->fs_api_command_done = 1;
192762306a36Sopenharmony_ci
192862306a36Sopenharmony_ci	wake_up_interruptible(&a->fs_api_waiter);
192962306a36Sopenharmony_ci}
193062306a36Sopenharmony_ci
193162306a36Sopenharmony_ci/* Scatter/gather callback for VDA requests */
193262306a36Sopenharmony_cistatic u32 get_physaddr_fs_api(struct esas2r_sg_context *sgc, u64 *addr)
193362306a36Sopenharmony_ci{
193462306a36Sopenharmony_ci	struct esas2r_adapter *a = (struct esas2r_adapter *)sgc->adapter;
193562306a36Sopenharmony_ci	struct esas2r_ioctl_fs *fs =
193662306a36Sopenharmony_ci		(struct esas2r_ioctl_fs *)a->fs_api_buffer;
193762306a36Sopenharmony_ci	u32 offset = (u8 *)sgc->cur_offset - (u8 *)fs;
193862306a36Sopenharmony_ci
193962306a36Sopenharmony_ci	(*addr) = a->ppfs_api_buffer + offset;
194062306a36Sopenharmony_ci
194162306a36Sopenharmony_ci	return a->fs_api_buffer_size - offset;
194262306a36Sopenharmony_ci}
194362306a36Sopenharmony_ci
194462306a36Sopenharmony_ci/* Handle a call to read firmware via FS_API. */
194562306a36Sopenharmony_ciint esas2r_read_fs(struct esas2r_adapter *a, char *buf, long off, int count)
194662306a36Sopenharmony_ci{
194762306a36Sopenharmony_ci	if (!a->fs_api_buffer)
194862306a36Sopenharmony_ci		return -ENOMEM;
194962306a36Sopenharmony_ci
195062306a36Sopenharmony_ci	if (off == 0) {
195162306a36Sopenharmony_ci		struct esas2r_request *rq;
195262306a36Sopenharmony_ci		struct esas2r_sg_context sgc;
195362306a36Sopenharmony_ci		struct esas2r_ioctl_fs *fs =
195462306a36Sopenharmony_ci			(struct esas2r_ioctl_fs *)a->fs_api_buffer;
195562306a36Sopenharmony_ci
195662306a36Sopenharmony_ci		/* If another flash request is already in progress, return. */
195762306a36Sopenharmony_ci		if (mutex_lock_interruptible(&a->fs_api_mutex)) {
195862306a36Sopenharmony_cibusy:
195962306a36Sopenharmony_ci			fs->status = ATTO_STS_OUT_OF_RSRC;
196062306a36Sopenharmony_ci			return -EBUSY;
196162306a36Sopenharmony_ci		}
196262306a36Sopenharmony_ci
196362306a36Sopenharmony_ci		/*
196462306a36Sopenharmony_ci		 * Presumeably, someone has already written to the
196562306a36Sopenharmony_ci		 * fs_api_buffer, and now they are reading the node the
196662306a36Sopenharmony_ci		 * response, so now we will actually issue the request to the
196762306a36Sopenharmony_ci		 * chip and reply. Allocate a request
196862306a36Sopenharmony_ci		 */
196962306a36Sopenharmony_ci
197062306a36Sopenharmony_ci		rq = esas2r_alloc_request(a);
197162306a36Sopenharmony_ci		if (rq == NULL) {
197262306a36Sopenharmony_ci			esas2r_debug("esas2r_read_fs: out of requests");
197362306a36Sopenharmony_ci			mutex_unlock(&a->fs_api_mutex);
197462306a36Sopenharmony_ci			goto busy;
197562306a36Sopenharmony_ci		}
197662306a36Sopenharmony_ci
197762306a36Sopenharmony_ci		rq->comp_cb = fs_api_complete_req;
197862306a36Sopenharmony_ci
197962306a36Sopenharmony_ci		/* Set up the SGCONTEXT for to build the s/g table */
198062306a36Sopenharmony_ci
198162306a36Sopenharmony_ci		sgc.cur_offset = fs->data;
198262306a36Sopenharmony_ci		sgc.get_phys_addr = (PGETPHYSADDR)get_physaddr_fs_api;
198362306a36Sopenharmony_ci
198462306a36Sopenharmony_ci		a->fs_api_command_done = 0;
198562306a36Sopenharmony_ci
198662306a36Sopenharmony_ci		if (!esas2r_process_fs_ioctl(a, fs, rq, &sgc)) {
198762306a36Sopenharmony_ci			if (fs->status == ATTO_STS_OUT_OF_RSRC)
198862306a36Sopenharmony_ci				count = -EBUSY;
198962306a36Sopenharmony_ci
199062306a36Sopenharmony_ci			goto dont_wait;
199162306a36Sopenharmony_ci		}
199262306a36Sopenharmony_ci
199362306a36Sopenharmony_ci		/* Now wait around for it to complete. */
199462306a36Sopenharmony_ci
199562306a36Sopenharmony_ci		while (!a->fs_api_command_done)
199662306a36Sopenharmony_ci			wait_event_interruptible(a->fs_api_waiter,
199762306a36Sopenharmony_ci						 a->fs_api_command_done);
199862306a36Sopenharmony_ci		;
199962306a36Sopenharmony_cidont_wait:
200062306a36Sopenharmony_ci		/* Free the request and keep going */
200162306a36Sopenharmony_ci		mutex_unlock(&a->fs_api_mutex);
200262306a36Sopenharmony_ci		esas2r_free_request(a, (struct esas2r_request *)rq);
200362306a36Sopenharmony_ci
200462306a36Sopenharmony_ci		/* Pick up possible error code from above */
200562306a36Sopenharmony_ci		if (count < 0)
200662306a36Sopenharmony_ci			return count;
200762306a36Sopenharmony_ci	}
200862306a36Sopenharmony_ci
200962306a36Sopenharmony_ci	if (off > a->fs_api_buffer_size)
201062306a36Sopenharmony_ci		return 0;
201162306a36Sopenharmony_ci
201262306a36Sopenharmony_ci	if (count + off > a->fs_api_buffer_size)
201362306a36Sopenharmony_ci		count = a->fs_api_buffer_size - off;
201462306a36Sopenharmony_ci
201562306a36Sopenharmony_ci	if (count < 0)
201662306a36Sopenharmony_ci		return 0;
201762306a36Sopenharmony_ci
201862306a36Sopenharmony_ci	memcpy(buf, a->fs_api_buffer + off, count);
201962306a36Sopenharmony_ci
202062306a36Sopenharmony_ci	return count;
202162306a36Sopenharmony_ci}
202262306a36Sopenharmony_ci
202362306a36Sopenharmony_ci/* Handle a call to write firmware via FS_API. */
202462306a36Sopenharmony_ciint esas2r_write_fs(struct esas2r_adapter *a, const char *buf, long off,
202562306a36Sopenharmony_ci		    int count)
202662306a36Sopenharmony_ci{
202762306a36Sopenharmony_ci	if (off == 0) {
202862306a36Sopenharmony_ci		struct esas2r_ioctl_fs *fs = (struct esas2r_ioctl_fs *)buf;
202962306a36Sopenharmony_ci		u32 length = fs->command.length + offsetof(
203062306a36Sopenharmony_ci			struct esas2r_ioctl_fs,
203162306a36Sopenharmony_ci			data);
203262306a36Sopenharmony_ci
203362306a36Sopenharmony_ci		/*
203462306a36Sopenharmony_ci		 * Special case, for BEGIN commands, the length field
203562306a36Sopenharmony_ci		 * is lying to us, so just get enough for the header.
203662306a36Sopenharmony_ci		 */
203762306a36Sopenharmony_ci
203862306a36Sopenharmony_ci		if (fs->command.command == ESAS2R_FS_CMD_BEGINW)
203962306a36Sopenharmony_ci			length = offsetof(struct esas2r_ioctl_fs, data);
204062306a36Sopenharmony_ci
204162306a36Sopenharmony_ci		/*
204262306a36Sopenharmony_ci		 * Beginning a command.  We assume we'll get at least
204362306a36Sopenharmony_ci		 * enough in the first write so we can look at the
204462306a36Sopenharmony_ci		 * header and see how much we need to alloc.
204562306a36Sopenharmony_ci		 */
204662306a36Sopenharmony_ci
204762306a36Sopenharmony_ci		if (count < offsetof(struct esas2r_ioctl_fs, data))
204862306a36Sopenharmony_ci			return -EINVAL;
204962306a36Sopenharmony_ci
205062306a36Sopenharmony_ci		/* Allocate a buffer or use the existing buffer. */
205162306a36Sopenharmony_ci		if (a->fs_api_buffer) {
205262306a36Sopenharmony_ci			if (a->fs_api_buffer_size < length) {
205362306a36Sopenharmony_ci				/* Free too-small buffer and get a new one */
205462306a36Sopenharmony_ci				dma_free_coherent(&a->pcid->dev,
205562306a36Sopenharmony_ci						  (size_t)a->fs_api_buffer_size,
205662306a36Sopenharmony_ci						  a->fs_api_buffer,
205762306a36Sopenharmony_ci						  (dma_addr_t)a->ppfs_api_buffer);
205862306a36Sopenharmony_ci
205962306a36Sopenharmony_ci				goto re_allocate_buffer;
206062306a36Sopenharmony_ci			}
206162306a36Sopenharmony_ci		} else {
206262306a36Sopenharmony_cire_allocate_buffer:
206362306a36Sopenharmony_ci			a->fs_api_buffer_size = length;
206462306a36Sopenharmony_ci
206562306a36Sopenharmony_ci			a->fs_api_buffer = dma_alloc_coherent(&a->pcid->dev,
206662306a36Sopenharmony_ci							      (size_t)a->fs_api_buffer_size,
206762306a36Sopenharmony_ci							      (dma_addr_t *)&a->ppfs_api_buffer,
206862306a36Sopenharmony_ci							      GFP_KERNEL);
206962306a36Sopenharmony_ci		}
207062306a36Sopenharmony_ci	}
207162306a36Sopenharmony_ci
207262306a36Sopenharmony_ci	if (!a->fs_api_buffer)
207362306a36Sopenharmony_ci		return -ENOMEM;
207462306a36Sopenharmony_ci
207562306a36Sopenharmony_ci	if (off > a->fs_api_buffer_size)
207662306a36Sopenharmony_ci		return 0;
207762306a36Sopenharmony_ci
207862306a36Sopenharmony_ci	if (count + off > a->fs_api_buffer_size)
207962306a36Sopenharmony_ci		count = a->fs_api_buffer_size - off;
208062306a36Sopenharmony_ci
208162306a36Sopenharmony_ci	if (count < 1)
208262306a36Sopenharmony_ci		return 0;
208362306a36Sopenharmony_ci
208462306a36Sopenharmony_ci	memcpy(a->fs_api_buffer + off, buf, count);
208562306a36Sopenharmony_ci
208662306a36Sopenharmony_ci	return count;
208762306a36Sopenharmony_ci}
2088