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