Changeset 56c0930 in mainline for uspace/drv/bus/usb/ar9271/ar9271.c

Timestamp:

2015-02-20T14:33:29Z (9 years ago)

Author:

Jan Kolarik <kolarik@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

4cb0148

Parents:

ab365c4

Message:

Started writing TX and RX handlers, VIF init, setting RX filter, PLL init and calibration, some corrections. Added HW values array initialization, registered diagnostic polling fibril. But still not receiving any packets…

File:

• uspace/drv/bus/usb/ar9271/ar9271.c (modified) (10 diffs)

uspace/drv/bus/usb/ar9271/ar9271.c

@@ -101 +101 @@
 /* IEEE802.11 callbacks */
 static int ar9271_ieee80211_start(ieee80211_dev_t *ieee80211_dev);
+static int ar9271_ieee80211_tx_handler(ieee80211_dev_t *ieee80211_dev,
+        void *buffer, size_t buffer_size);
 
 static driver_ops_t ar9271_driver_ops = {
@@ -112 +114 @@
 
 static ieee80211_ops_t ar9271_ieee80211_ops = {
-        .start = ar9271_ieee80211_start
-};
-
-static int ar9271_set_rx_filter(ar9271_t *ar9271)
-{
-        uint32_t filter_bits;
-        int rc = wmi_reg_read(ar9271->htc_device, AR9271_RX_FILTER, 
-                &filter_bits);
-        if(rc != EOK) {
-                usb_log_error("Failed to read RX filter.\n");
-                return EINVAL;
-        }
-        
-        /* TODO: Do proper filtering here. */
-        
-        filter_bits |= AR9271_RX_FILTER_UNI | AR9271_RX_FILTER_MULTI | 
-                AR9271_RX_FILTER_BROAD | AR9271_RX_FILTER_PROMISCUOUS;
-        
-        rc = wmi_reg_write(ar9271->htc_device, AR9271_RX_FILTER, filter_bits);
-        if(rc != EOK) {
-                usb_log_error("Failed to write RX filter.\n");
-                return EINVAL;
-        }
-        
-        return EOK;
-}
-
-static int ar9271_rx_init(ar9271_t *ar9271)
-{
-        int rc = wmi_reg_write(ar9271->htc_device, AR9271_COMMAND, 
-                AR9271_COMMAND_RX_ENABLE);
-        if(rc != EOK) {
-                usb_log_error("Failed to send RX enable command.\n");
-                return EINVAL;
-        }
-        
-        rc = ar9271_set_rx_filter(ar9271);
-        if(rc != EOK) {
-                usb_log_error("Failed to set RX filtering.\n");
-                return EINVAL;
-        }
+        .start = ar9271_ieee80211_start,
+        .tx_handler = ar9271_ieee80211_tx_handler
+};
+
+static int ar9271_ieee80211_tx_handler(ieee80211_dev_t *ieee80211_dev,
+        void *buffer, size_t buffer_size)
+{
+        /* TODO: Process TX message properly */
+        
+        size_t complete_size, offset;
+        void *complete_buffer;
+        int endpoint;
+        
+        ar9271_t *ar9271 = (ar9271_t *) ieee80211_dev->driver_data;
+        
+        ieee80211_header_t *ieee80211_header = (ieee80211_header_t *) buffer;
+        
+        if(ieee80211_is_data_frame(ieee80211_header)) {
+                offset = sizeof(htc_frame_header_t);
+                complete_size = buffer_size + offset;
+                complete_buffer = malloc(complete_size);
+                endpoint = ar9271->htc_device->endpoints.data_be_endpoint;
+        } else {
+                offset = sizeof(htc_tx_management_header_t) +
+                        sizeof(htc_frame_header_t);
+                complete_size = buffer_size + offset;
+                complete_buffer = malloc(complete_size);
+                endpoint = ar9271->htc_device->endpoints.mgmt_endpoint;
+        }
+        
+        /* Copy IEEE802.11 data to new allocated buffer with HTC headers. */
+        memcpy(complete_buffer + offset, buffer, buffer_size);
+        
+        htc_send_data_message(ar9271->htc_device, complete_buffer,
+                complete_size, endpoint);
+        
+        free(complete_buffer);
+        
+        return EOK;
+}
+
+static int ar9271_data_polling(void *arg)
+{
+        ar9271_t *ar9271 = (ar9271_t *) arg;
+        size_t buffer_size = ar9271->ath_device->data_response_length;
+        void *buffer = malloc(buffer_size);
+        
+        while(true) {
+                int rc = 
+                htc_read_data_message(ar9271->htc_device, buffer, buffer_size,
+                        NULL);
+                usb_log_info("RC is %d.\n", rc);
+                
+                /* TODO: Process RX message */
+        }
+        
+        return EOK;
+}
+
+static int ar9271_diag_polling(void *arg)
+{
+        ar9271_t *ar9271 = (ar9271_t *) arg;
+        
+        while(true) {
+                uint32_t result;
+                wmi_reg_read(ar9271->htc_device, 0x80F0, &result);
+                usb_log_info("RX count: %x\n", result);
+                wmi_reg_read(ar9271->htc_device, 0x8098, &result);
+                usb_log_info("Beacon count: %x\n", result);
+                sleep(1);
+        }
+        
+        return EOK;
+}
+
+static int ar9271_register_polling_fibrils(ar9271_t *ar9271)
+{
+        /* Add data polling fibril. */
+        fid_t fibril = fibril_create(ar9271_data_polling, ar9271);
+        if (fibril == 0) {
+                return ENOMEM;
+        }
+        fibril_add_ready(fibril);
+        
+        /* Add debug polling fibril. */
+        fibril = fibril_create(ar9271_diag_polling, ar9271);
+        if (fibril == 0) {
+                return ENOMEM;
+        }
+        fibril_add_ready(fibril);
         
         return EOK;
@@ -165 +216 @@
         if(rc != EOK) {
                 usb_log_error("Failed to flush receiving buffer.\n");
-                return EINVAL;
+                return rc;
         }
         
@@ -171 +222 @@
         if(rc != EOK) {
                 usb_log_error("Failed to do HW reset.\n");
-                return EINVAL;
+                return rc;
         }
         
@@ -179 +230 @@
         if(rc != EOK) {
                 usb_log_error("Failed to set HTC mode.\n");
-                return EINVAL;
+                return rc;
         }
         
@@ -186 +237 @@
         if(rc != EOK) {
                 usb_log_error("Failed to send ath init command.\n");
-                return EINVAL;
+                return rc;
         }
         
@@ -193 +244 @@
         if(rc != EOK) {
                 usb_log_error("Failed to send receiving init command.\n");
-                return EINVAL;
-        }
-        
-        rc = ar9271_rx_init(ar9271);
+                return rc;
+        }
+        
+        rc = hw_rx_init(ar9271);
         if(rc != EOK) {
                 usb_log_error("Failed to initialize RX.\n");
-                return EINVAL;
+                return rc;
+        }
+        
+        rc = htc_init_new_vif(ar9271->htc_device);
+        if(rc != EOK) {
+                usb_log_error("Failed to initialize new VIF.\n");
+                return rc;
+        }
+        
+        rc = ar9271_register_polling_fibrils(ar9271);
+        if(rc != EOK) {
+                usb_log_error("Failed to register polling fibrils.\n");
+                return rc;
         }
         
@@ -220 +283 @@
                 free(ar9271->ath_device);
                 usb_log_error("Failed to initialize ath device.\n");
-                return EINVAL;
+                return rc;
+        }
+        
+        /* IEEE 802.11 framework structure initialization. */
+        ar9271->ieee80211_dev = calloc(1, sizeof(ieee80211_dev_t));
+        if (!ar9271->ieee80211_dev) {
+                free(ar9271->ath_device);
+                usb_log_error("Failed to allocate memory for IEEE80211 device "
+                    "structure.\n");
+                return ENOMEM;
+        }
+        
+        rc = ieee80211_device_init(ar9271->ieee80211_dev, ar9271, 
+                ar9271->ddf_dev);
+        if(rc != EOK) {
+                free(ar9271->ieee80211_dev);
+                free(ar9271->ath_device);
+                usb_log_error("Failed to initialize IEEE80211 device structure."
+                        "\n");
+                return rc;
         }
                 
@@ -226 +308 @@
         ar9271->htc_device = calloc(1, sizeof(htc_device_t));
         if(!ar9271->htc_device) {
+                free(ar9271->ieee80211_dev);
                 free(ar9271->ath_device);
                 usb_log_error("Failed to allocate memory for HTC device "
@@ -232 +315 @@
         }
         
-        rc = htc_device_init(ar9271->ath_device, ar9271->htc_device);
+        rc = htc_device_init(ar9271->ath_device, ar9271->ieee80211_dev, 
+                ar9271->htc_device);
         if(rc != EOK) {
                 free(ar9271->htc_device);
+                free(ar9271->ieee80211_dev);
                 free(ar9271->ath_device);
                 usb_log_error("Failed to initialize HTC device structure.\n");
-                return EINVAL;
-        }
-        
-        /* IEEE 802.11 framework structure initialization. */
-        ar9271->ieee80211_dev = calloc(1, sizeof(ieee80211_dev_t));
-        if (!ar9271->ieee80211_dev) {
-                free(ar9271->htc_device);
-                free(ar9271->ath_device);
-                usb_log_error("Failed to allocate memory for IEEE80211 device "
-                    "structure.\n");
-                return ENOMEM;
-        }
-        
-        rc = ieee80211_device_init(ar9271->ieee80211_dev, ar9271, 
-                ar9271->ddf_dev);
-        if(rc != EOK) {
-                free(ar9271->ieee80211_dev);
-                free(ar9271->htc_device);
-                free(ar9271->ath_device);
-                usb_log_error("Failed to initialize IEEE80211 device structure."
-                        "\n");
-                return EINVAL;
+                return rc;
         }