+++ /dev/null
-/*
- * Copyright (c) 2013 Qualcomm Atheros, Inc.
- * All rights reserved.
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted (subject to the limitations in the
- * disclaimer below) provided that the following conditions are met:
- *
- * * Redistributions of source code must retain the above copyright
- * notice, this list of conditions and the following disclaimer.
- *
- * * Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the
- * distribution.
- *
- * * Neither the name of Qualcomm Atheros nor the names of its
- * contributors may be used to endorse or promote products derived
- * from this software without specific prior written permission.
- *
- * NO EXPRESS OR IMPLIED LICENSES TO ANY PARTY'S PATENT RIGHTS ARE
- * GRANTED BY THIS LICENSE. THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT
- * HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED
- * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
- * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
- * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
- * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
- * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
- * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
- * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
- * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
- * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
- * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- */
-#include <OTUS/OTUS_soc.h>
-#include <cmnos_api.h>
-#include <hif_api.h>
-#include <Magpie_api.h>
-#include <dma_lib.h>
-#include <hif_pci.h>
-#include <vbuf_api.h>
-
-#include "fwd.h"
-
-fwd_tgt_softc_t fwd_sc;
-
-void fwd_tgt_recv(VBUF *hdr_buf, VBUF *buf, void *ctx );
-void fwd_retbuf_handler(VBUF *buf, void *ServiceCtx);
-
-hif_handle_t fwd_init()
- {
- HIF_CALLBACK hifconfig;
- A_UINT32 size, res_headroom;
-
- hifconfig.send_buf_done = fwd_retbuf_handler;
- hifconfig.recv_buf = fwd_tgt_recv;
- hifconfig.context = &fwd_sc;
-
- res_headroom = HIF_get_reserved_headroom(NULL);
-
- size = sizeof(fwd_rsp_t) + res_headroom;
-
- HIF_register_callback(NULL, &hifconfig);
-
- HIF_get_default_pipe(NULL, &fwd_sc.rx_pipe, &fwd_sc.tx_pipe);
-
- return NULL;
- }
-
-void
-fwd_retbuf_handler(VBUF *buf, void *ServiceCtx)
-{
- HIF_return_recv_buf(fwd_sc.hif_handle, fwd_sc.rx_pipe, buf);
-}
-
-a_status_t
-fwd_tgt_process_last(A_UINT32 size, A_UINT32 cksum)
-{
- int i, checksum = 0;
- A_UINT32 *image = (A_UINT32 *)fwd_sc.addr;
-
- for (i = 0 ; i < size; i += 4, image++)
- checksum = checksum ^ *image;
-
- if (checksum == cksum)
- return A_STATUS_OK;
- else
- return A_STATUS_FAILED;
-}
-
-
-
-void
-fwd_tgt_recv(VBUF *hdr_buf, VBUF *buf, void *ctx )
-{
- volatile a_uint8_t *data;
- A_UINT32 len, seglen, offset, i, more, eloc;
- volatile A_UINT32 *image, *daddr;
- volatile fwd_cmd_t *c;
- volatile fwd_rsp_t *r;
- jmp_func funcptr;
- a_status_t status;
- VDESC *desc = NULL;
-
- data = buf->desc_list->buf_addr + buf->desc_list->data_offset;
- seglen = buf->desc_list->data_size;
-
- c = (fwd_cmd_t *)data;
- len = c->len;
- offset = c->offset;
- more = c->more_data;
- image = (A_UINT32 *)(c + 1);
-
- if (offset == 0) {
- fwd_sc.addr = (A_UINT32)(*image);
- image ++;
- }
-
- daddr = (A_UINT32 *)(fwd_sc.addr + offset);
-
- if (!more) {
- len -= 4;
- }
-
- for (i = 0 ; i < len; i += 4) {
- *daddr = *image;
- image ++;
- daddr ++;
- }
-
- desc = buf->desc_list;
- while(desc->next_desc != NULL)
- desc = desc->next_desc;
- desc->data_size -= seglen;
- buf->buf_length -= seglen;
-
- r = (fwd_rsp_t *)(desc->buf_addr + desc->data_offset + desc->data_size);
- desc->data_size += sizeof(fwd_rsp_t);
- buf->buf_length += sizeof(fwd_rsp_t);
-
- r->offset = c->offset;
-
- if (more) {
- r->rsp = FWD_RSP_ACK;
- goto done;
- }
-
- status = fwd_tgt_process_last(offset + len, *image);
-
- /* reach to the jump location */
- image++;
- eloc = *image;
-
- if (status == A_STATUS_OK)
- r->rsp = FWD_RSP_SUCCESS;
- else
- r->rsp = FWD_RSP_FAILED;
-
-
-done:
- HIF_send_buffer(fwd_sc.hif_handle, fwd_sc.tx_pipe, buf);
-
- if (!more && (status == A_STATUS_OK)) {
- funcptr = (jmp_func)eloc;
- funcptr();
- }
-}