Index: chromeos/drivers/ath6kl/os/linux/ar6000_raw_if.c |
diff --git a/chromeos/drivers/ath6kl/os/linux/ar6000_raw_if.c b/chromeos/drivers/ath6kl/os/linux/ar6000_raw_if.c |
new file mode 100644 |
index 0000000000000000000000000000000000000000..c3650a5981ffd35187973526e6c97f3f1f16d7e6 |
--- /dev/null |
+++ b/chromeos/drivers/ath6kl/os/linux/ar6000_raw_if.c |
@@ -0,0 +1,437 @@ |
+/* |
+ * |
+ * Copyright (c) 2004-2007 Atheros Communications Inc. |
+ * All rights reserved. |
+ * |
+ * |
+// This program is free software; you can redistribute it and/or modify |
+// it under the terms of the GNU General Public License version 2 as |
+// published by the Free Software Foundation; |
+// |
+// Software distributed under the License is distributed on an "AS |
+// IS" basis, WITHOUT WARRANTY OF ANY KIND, either express or |
+// implied. See the License for the specific language governing |
+// rights and limitations under the License. |
+// |
+// |
+ * |
+ */ |
+ |
+#include "ar6000_drv.h" |
+ |
+#ifdef HTC_RAW_INTERFACE |
+ |
+static void |
+ar6000_htc_raw_read_cb(void *Context, HTC_PACKET *pPacket) |
+{ |
+ AR_SOFTC_T *ar = (AR_SOFTC_T *)Context; |
+ raw_htc_buffer *busy; |
+ HTC_RAW_STREAM_ID streamID; |
+ |
+ busy = (raw_htc_buffer *)pPacket->pPktContext; |
+ A_ASSERT(busy != NULL); |
+ |
+ if (pPacket->Status == A_ECANCELED) { |
+ /* |
+ * HTC provides A_ECANCELED status when it doesn't want to be refilled |
+ * (probably due to a shutdown) |
+ */ |
+ return; |
+ } |
+ |
+ streamID = arEndpoint2RawStreamID(ar,pPacket->Endpoint); |
+ A_ASSERT(streamID != HTC_RAW_STREAM_NOT_MAPPED); |
+ |
+#ifdef CF |
+ if (down_trylock(&ar->raw_htc_read_sem[streamID])) { |
+#else |
+ if (down_interruptible(&ar->raw_htc_read_sem[streamID])) { |
+#endif /* CF */ |
+ AR_DEBUG_PRINTF(ATH_DEBUG_ERR,("Unable to down the semaphore\n")); |
+ } |
+ |
+ A_ASSERT((pPacket->Status != A_OK) || |
+ (pPacket->pBuffer == (busy->data + HTC_HEADER_LEN))); |
+ |
+ busy->length = pPacket->ActualLength + HTC_HEADER_LEN; |
+ busy->currPtr = HTC_HEADER_LEN; |
+ ar->read_buffer_available[streamID] = TRUE; |
+ //AR_DEBUG_PRINTF(ATH_DEBUG_ERR,("raw read cb: 0x%X 0x%X \n", busy->currPtr,busy->length); |
+ up(&ar->raw_htc_read_sem[streamID]); |
+ |
+ /* Signal the waiting process */ |
+ AR_DEBUG_PRINTF(ATH_DEBUG_HTC_RAW,("Waking up the StreamID(%d) read process\n", streamID)); |
+ wake_up_interruptible(&ar->raw_htc_read_queue[streamID]); |
+} |
+ |
+static void |
+ar6000_htc_raw_write_cb(void *Context, HTC_PACKET *pPacket) |
+{ |
+ AR_SOFTC_T *ar = (AR_SOFTC_T *)Context; |
+ raw_htc_buffer *free; |
+ HTC_RAW_STREAM_ID streamID; |
+ |
+ free = (raw_htc_buffer *)pPacket->pPktContext; |
+ A_ASSERT(free != NULL); |
+ |
+ if (pPacket->Status == A_ECANCELED) { |
+ /* |
+ * HTC provides A_ECANCELED status when it doesn't want to be refilled |
+ * (probably due to a shutdown) |
+ */ |
+ return; |
+ } |
+ |
+ streamID = arEndpoint2RawStreamID(ar,pPacket->Endpoint); |
+ A_ASSERT(streamID != HTC_RAW_STREAM_NOT_MAPPED); |
+ |
+#ifdef CF |
+ if (down_trylock(&ar->raw_htc_write_sem[streamID])) { |
+#else |
+ if (down_interruptible(&ar->raw_htc_write_sem[streamID])) { |
+#endif |
+ AR_DEBUG_PRINTF(ATH_DEBUG_ERR,("Unable to down the semaphore\n")); |
+ } |
+ |
+ A_ASSERT(pPacket->pBuffer == (free->data + HTC_HEADER_LEN)); |
+ |
+ free->length = 0; |
+ ar->write_buffer_available[streamID] = TRUE; |
+ up(&ar->raw_htc_write_sem[streamID]); |
+ |
+ /* Signal the waiting process */ |
+ AR_DEBUG_PRINTF(ATH_DEBUG_HTC_RAW,("Waking up the StreamID(%d) write process\n", streamID)); |
+ wake_up_interruptible(&ar->raw_htc_write_queue[streamID]); |
+} |
+ |
+/* connect to a service */ |
+static A_STATUS ar6000_connect_raw_service(AR_SOFTC_T *ar, |
+ HTC_RAW_STREAM_ID StreamID) |
+{ |
+ A_STATUS status; |
+ HTC_SERVICE_CONNECT_RESP response; |
+ A_UINT8 streamNo; |
+ HTC_SERVICE_CONNECT_REQ connect; |
+ |
+ do { |
+ |
+ A_MEMZERO(&connect,sizeof(connect)); |
+ /* pass the stream ID as meta data to the RAW streams service */ |
+ streamNo = (A_UINT8)StreamID; |
+ connect.pMetaData = &streamNo; |
+ connect.MetaDataLength = sizeof(A_UINT8); |
+ /* these fields are the same for all endpoints */ |
+ connect.EpCallbacks.pContext = ar; |
+ connect.EpCallbacks.EpTxComplete = ar6000_htc_raw_write_cb; |
+ connect.EpCallbacks.EpRecv = ar6000_htc_raw_read_cb; |
+ /* simple interface, we don't need these optional callbacks */ |
+ connect.EpCallbacks.EpRecvRefill = NULL; |
+ connect.EpCallbacks.EpSendFull = NULL; |
+ connect.MaxSendQueueDepth = RAW_HTC_WRITE_BUFFERS_NUM; |
+ |
+ /* connect to the raw streams service, we may be able to get 1 or more |
+ * connections, depending on WHAT is running on the target */ |
+ connect.ServiceID = HTC_RAW_STREAMS_SVC; |
+ |
+ A_MEMZERO(&response,sizeof(response)); |
+ |
+ /* try to connect to the raw stream, it is okay if this fails with |
+ * status HTC_SERVICE_NO_MORE_EP */ |
+ status = HTCConnectService(ar->arHtcTarget, |
+ &connect, |
+ &response); |
+ |
+ if (A_FAILED(status)) { |
+ if (response.ConnectRespCode == HTC_SERVICE_NO_MORE_EP) { |
+ AR_DEBUG_PRINTF(ATH_DEBUG_ERR,("HTC RAW , No more streams allowed \n")); |
+ status = A_OK; |
+ } |
+ break; |
+ } |
+ |
+ /* set endpoint mapping for the RAW HTC streams */ |
+ arSetRawStream2EndpointIDMap(ar,StreamID,response.Endpoint); |
+ |
+ AR_DEBUG_PRINTF(ATH_DEBUG_HTC_RAW,("HTC RAW : stream ID: %d, endpoint: %d\n", |
+ StreamID, arRawStream2EndpointID(ar,StreamID))); |
+ |
+ } while (FALSE); |
+ |
+ return status; |
+} |
+ |
+int ar6000_htc_raw_open(AR_SOFTC_T *ar) |
+{ |
+ A_STATUS status; |
+ int streamID, endPt, count2; |
+ raw_htc_buffer *buffer; |
+ HTC_SERVICE_ID servicepriority; |
+ |
+ A_ASSERT(ar->arHtcTarget != NULL); |
+ |
+ /* wait for target */ |
+ status = HTCWaitTarget(ar->arHtcTarget); |
+ |
+ if (A_FAILED(status)) { |
+ AR_DEBUG_PRINTF(ATH_DEBUG_ERR,("HTCWaitTarget failed (%d)\n", status)); |
+ return -ENODEV; |
+ } |
+ |
+ for (endPt = 0; endPt < ENDPOINT_MAX; endPt++) { |
+ ar->arEp2RawMapping[endPt] = HTC_RAW_STREAM_NOT_MAPPED; |
+ } |
+ |
+ for (streamID = HTC_RAW_STREAM_0; streamID < HTC_RAW_STREAM_NUM_MAX; streamID++) { |
+ /* Initialize the data structures */ |
+ init_MUTEX(&ar->raw_htc_read_sem[streamID]); |
+ init_MUTEX(&ar->raw_htc_write_sem[streamID]); |
+ init_waitqueue_head(&ar->raw_htc_read_queue[streamID]); |
+ init_waitqueue_head(&ar->raw_htc_write_queue[streamID]); |
+ |
+ /* try to connect to the raw service */ |
+ status = ar6000_connect_raw_service(ar,streamID); |
+ |
+ if (A_FAILED(status)) { |
+ break; |
+ } |
+ |
+ if (arRawStream2EndpointID(ar,streamID) == 0) { |
+ break; |
+ } |
+ |
+ for (count2 = 0; count2 < RAW_HTC_READ_BUFFERS_NUM; count2 ++) { |
+ /* Initialize the receive buffers */ |
+ buffer = &ar->raw_htc_write_buffer[streamID][count2]; |
+ memset(buffer, 0, sizeof(raw_htc_buffer)); |
+ buffer = &ar->raw_htc_read_buffer[streamID][count2]; |
+ memset(buffer, 0, sizeof(raw_htc_buffer)); |
+ |
+ SET_HTC_PACKET_INFO_RX_REFILL(&buffer->HTCPacket, |
+ buffer, |
+ buffer->data, |
+ HTC_RAW_BUFFER_SIZE, |
+ arRawStream2EndpointID(ar,streamID)); |
+ |
+ /* Queue buffers to HTC for receive */ |
+ if ((status = HTCAddReceivePkt(ar->arHtcTarget, &buffer->HTCPacket)) != A_OK) |
+ { |
+ BMIInit(); |
+ return -EIO; |
+ } |
+ } |
+ |
+ for (count2 = 0; count2 < RAW_HTC_WRITE_BUFFERS_NUM; count2 ++) { |
+ /* Initialize the receive buffers */ |
+ buffer = &ar->raw_htc_write_buffer[streamID][count2]; |
+ memset(buffer, 0, sizeof(raw_htc_buffer)); |
+ } |
+ |
+ ar->read_buffer_available[streamID] = FALSE; |
+ ar->write_buffer_available[streamID] = TRUE; |
+ } |
+ |
+ if (A_FAILED(status)) { |
+ return -EIO; |
+ } |
+ |
+ AR_DEBUG_PRINTF(ATH_DEBUG_INFO,("HTC RAW, number of streams the target supports: %d \n", streamID)); |
+ |
+ servicepriority = HTC_RAW_STREAMS_SVC; /* only 1 */ |
+ |
+ /* set callbacks and priority list */ |
+ HTCSetCreditDistribution(ar->arHtcTarget, |
+ ar, |
+ NULL, /* use default */ |
+ NULL, /* use default */ |
+ &servicepriority, |
+ 1); |
+ |
+ /* Start the HTC component */ |
+ if ((status = HTCStart(ar->arHtcTarget)) != A_OK) { |
+ BMIInit(); |
+ return -EIO; |
+ } |
+ |
+ (ar)->arRawIfInit = TRUE; |
+ |
+ return 0; |
+} |
+ |
+int ar6000_htc_raw_close(AR_SOFTC_T *ar) |
+{ |
+ A_PRINTF("ar6000_htc_raw_close called \n"); |
+ HTCStop(ar->arHtcTarget); |
+ |
+ /* reset the device */ |
+ ar6000_reset_device(ar->arHifDevice, ar->arTargetType, TRUE, FALSE); |
+ /* Initialize the BMI component */ |
+ BMIInit(); |
+ |
+ return 0; |
+} |
+ |
+raw_htc_buffer * |
+get_filled_buffer(AR_SOFTC_T *ar, HTC_RAW_STREAM_ID StreamID) |
+{ |
+ int count; |
+ raw_htc_buffer *busy; |
+ |
+ /* Check for data */ |
+ for (count = 0; count < RAW_HTC_READ_BUFFERS_NUM; count ++) { |
+ busy = &ar->raw_htc_read_buffer[StreamID][count]; |
+ if (busy->length) { |
+ break; |
+ } |
+ } |
+ if (busy->length) { |
+ ar->read_buffer_available[StreamID] = TRUE; |
+ } else { |
+ ar->read_buffer_available[StreamID] = FALSE; |
+ } |
+ |
+ return busy; |
+} |
+ |
+ssize_t ar6000_htc_raw_read(AR_SOFTC_T *ar, HTC_RAW_STREAM_ID StreamID, |
+ char __user *buffer, size_t length) |
+{ |
+ int readPtr; |
+ raw_htc_buffer *busy; |
+ |
+ if (arRawStream2EndpointID(ar,StreamID) == 0) { |
+ AR_DEBUG_PRINTF(ATH_DEBUG_ERR,("StreamID(%d) not connected! \n", StreamID)); |
+ return -EFAULT; |
+ } |
+ |
+ if (down_interruptible(&ar->raw_htc_read_sem[StreamID])) { |
+ return -ERESTARTSYS; |
+ } |
+ |
+ busy = get_filled_buffer(ar,StreamID); |
+ while (!ar->read_buffer_available[StreamID]) { |
+ up(&ar->raw_htc_read_sem[StreamID]); |
+ |
+ /* Wait for the data */ |
+ AR_DEBUG_PRINTF(ATH_DEBUG_HTC_RAW,("Sleeping StreamID(%d) read process\n", StreamID)); |
+ if (wait_event_interruptible(ar->raw_htc_read_queue[StreamID], |
+ ar->read_buffer_available[StreamID])) |
+ { |
+ return -EINTR; |
+ } |
+ if (down_interruptible(&ar->raw_htc_read_sem[StreamID])) { |
+ return -ERESTARTSYS; |
+ } |
+ busy = get_filled_buffer(ar,StreamID); |
+ } |
+ |
+ /* Read the data */ |
+ readPtr = busy->currPtr; |
+ if (length > busy->length - HTC_HEADER_LEN) { |
+ length = busy->length - HTC_HEADER_LEN; |
+ } |
+ if (copy_to_user(buffer, &busy->data[readPtr], length)) { |
+ up(&ar->raw_htc_read_sem[StreamID]); |
+ return -EFAULT; |
+ } |
+ |
+ busy->currPtr += length; |
+ |
+ if (busy->currPtr == busy->length) |
+ { |
+ busy->currPtr = 0; |
+ busy->length = 0; |
+ HTC_PACKET_RESET_RX(&busy->HTCPacket); |
+ //AR_DEBUG_PRINTF(ATH_DEBUG_HTC_RAW,("raw read ioctl: ep for packet:%d \n", busy->HTCPacket.Endpoint)); |
+ HTCAddReceivePkt(ar->arHtcTarget, &busy->HTCPacket); |
+ } |
+ ar->read_buffer_available[StreamID] = FALSE; |
+ up(&ar->raw_htc_read_sem[StreamID]); |
+ |
+ return length; |
+} |
+ |
+static raw_htc_buffer * |
+get_free_buffer(AR_SOFTC_T *ar, HTC_ENDPOINT_ID StreamID) |
+{ |
+ int count; |
+ raw_htc_buffer *free; |
+ |
+ free = NULL; |
+ for (count = 0; count < RAW_HTC_WRITE_BUFFERS_NUM; count ++) { |
+ free = &ar->raw_htc_write_buffer[StreamID][count]; |
+ if (free->length == 0) { |
+ break; |
+ } |
+ } |
+ if (!free->length) { |
+ ar->write_buffer_available[StreamID] = TRUE; |
+ } else { |
+ ar->write_buffer_available[StreamID] = FALSE; |
+ } |
+ |
+ return free; |
+} |
+ |
+ssize_t ar6000_htc_raw_write(AR_SOFTC_T *ar, HTC_RAW_STREAM_ID StreamID, |
+ char __user *buffer, size_t length) |
+{ |
+ int writePtr; |
+ raw_htc_buffer *free; |
+ |
+ if (arRawStream2EndpointID(ar,StreamID) == 0) { |
+ AR_DEBUG_PRINTF(ATH_DEBUG_ERR,("StreamID(%d) not connected! \n", StreamID)); |
+ return -EFAULT; |
+ } |
+ |
+ if (down_interruptible(&ar->raw_htc_write_sem[StreamID])) { |
+ return -ERESTARTSYS; |
+ } |
+ |
+ /* Search for a free buffer */ |
+ free = get_free_buffer(ar,StreamID); |
+ |
+ /* Check if there is space to write else wait */ |
+ while (!ar->write_buffer_available[StreamID]) { |
+ up(&ar->raw_htc_write_sem[StreamID]); |
+ |
+ /* Wait for buffer to become free */ |
+ AR_DEBUG_PRINTF(ATH_DEBUG_HTC_RAW,("Sleeping StreamID(%d) write process\n", StreamID)); |
+ if (wait_event_interruptible(ar->raw_htc_write_queue[StreamID], |
+ ar->write_buffer_available[StreamID])) |
+ { |
+ return -EINTR; |
+ } |
+ if (down_interruptible(&ar->raw_htc_write_sem[StreamID])) { |
+ return -ERESTARTSYS; |
+ } |
+ free = get_free_buffer(ar,StreamID); |
+ } |
+ |
+ /* Send the data */ |
+ writePtr = HTC_HEADER_LEN; |
+ if (length > (HTC_RAW_BUFFER_SIZE - HTC_HEADER_LEN)) { |
+ length = HTC_RAW_BUFFER_SIZE - HTC_HEADER_LEN; |
+ } |
+ |
+ if (copy_from_user(&free->data[writePtr], buffer, length)) { |
+ up(&ar->raw_htc_read_sem[StreamID]); |
+ return -EFAULT; |
+ } |
+ |
+ free->length = length; |
+ |
+ SET_HTC_PACKET_INFO_TX(&free->HTCPacket, |
+ free, |
+ &free->data[writePtr], |
+ length, |
+ arRawStream2EndpointID(ar,StreamID), |
+ AR6K_DATA_PKT_TAG); |
+ |
+ HTCSendPkt(ar->arHtcTarget,&free->HTCPacket); |
+ |
+ ar->write_buffer_available[StreamID] = FALSE; |
+ up(&ar->raw_htc_write_sem[StreamID]); |
+ |
+ return length; |
+} |
+#endif /* HTC_RAW_INTERFACE */ |