| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1 | /* | 
| Ajit Khaparde | 294aedc | 2010-02-19 13:54:58 +0000 | [diff] [blame] | 2 | * Copyright (C) 2005 - 2010 ServerEngines | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 3 | * All rights reserved. | 
|  | 4 | * | 
|  | 5 | * This program is free software; you can redistribute it and/or | 
|  | 6 | * modify it under the terms of the GNU General Public License version 2 | 
|  | 7 | * as published by the Free Software Foundation.  The full GNU General | 
|  | 8 | * Public License is included in this distribution in the file called COPYING. | 
|  | 9 | * | 
|  | 10 | * Contact Information: | 
|  | 11 | * linux-drivers@serverengines.com | 
|  | 12 | * | 
|  | 13 | * ServerEngines | 
|  | 14 | * 209 N. Fair Oaks Ave | 
|  | 15 | * Sunnyvale, CA 94085 | 
|  | 16 | */ | 
|  | 17 |  | 
|  | 18 | #include "be.h" | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 19 | #include "be_cmds.h" | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 20 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 21 | static void be_mcc_notify(struct be_adapter *adapter) | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 22 | { | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 23 | struct be_queue_info *mccq = &adapter->mcc_obj.q; | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 24 | u32 val = 0; | 
|  | 25 |  | 
|  | 26 | val |= mccq->id & DB_MCCQ_RING_ID_MASK; | 
|  | 27 | val |= 1 << DB_MCCQ_NUM_POSTED_SHIFT; | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 28 | iowrite32(val, adapter->db + DB_MCCQ_OFFSET); | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 29 | } | 
|  | 30 |  | 
|  | 31 | /* To check if valid bit is set, check the entire word as we don't know | 
|  | 32 | * the endianness of the data (old entry is host endian while a new entry is | 
|  | 33 | * little endian) */ | 
| Sathya Perla | efd2e40 | 2009-07-27 22:53:10 +0000 | [diff] [blame] | 34 | static inline bool be_mcc_compl_is_new(struct be_mcc_compl *compl) | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 35 | { | 
|  | 36 | if (compl->flags != 0) { | 
|  | 37 | compl->flags = le32_to_cpu(compl->flags); | 
|  | 38 | BUG_ON((compl->flags & CQE_FLAGS_VALID_MASK) == 0); | 
|  | 39 | return true; | 
|  | 40 | } else { | 
|  | 41 | return false; | 
|  | 42 | } | 
|  | 43 | } | 
|  | 44 |  | 
|  | 45 | /* Need to reset the entire word that houses the valid bit */ | 
| Sathya Perla | efd2e40 | 2009-07-27 22:53:10 +0000 | [diff] [blame] | 46 | static inline void be_mcc_compl_use(struct be_mcc_compl *compl) | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 47 | { | 
|  | 48 | compl->flags = 0; | 
|  | 49 | } | 
|  | 50 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 51 | static int be_mcc_compl_process(struct be_adapter *adapter, | 
| Sathya Perla | efd2e40 | 2009-07-27 22:53:10 +0000 | [diff] [blame] | 52 | struct be_mcc_compl *compl) | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 53 | { | 
|  | 54 | u16 compl_status, extd_status; | 
|  | 55 |  | 
|  | 56 | /* Just swap the status to host endian; mcc tag is opaquely copied | 
|  | 57 | * from mcc_wrb */ | 
|  | 58 | be_dws_le_to_cpu(compl, 4); | 
|  | 59 |  | 
|  | 60 | compl_status = (compl->status >> CQE_STATUS_COMPL_SHIFT) & | 
|  | 61 | CQE_STATUS_COMPL_MASK; | 
| Sarveshwar Bandi | dd131e7 | 2010-05-25 16:16:32 -0700 | [diff] [blame] | 62 |  | 
|  | 63 | if ((compl->tag0 == OPCODE_COMMON_WRITE_FLASHROM) && | 
|  | 64 | (compl->tag1 == CMD_SUBSYSTEM_COMMON)) { | 
|  | 65 | adapter->flash_status = compl_status; | 
|  | 66 | complete(&adapter->flash_compl); | 
|  | 67 | } | 
|  | 68 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 69 | if (compl_status == MCC_STATUS_SUCCESS) { | 
|  | 70 | if (compl->tag0 == OPCODE_ETH_GET_STATISTICS) { | 
|  | 71 | struct be_cmd_resp_get_stats *resp = | 
|  | 72 | adapter->stats.cmd.va; | 
|  | 73 | be_dws_le_to_cpu(&resp->hw_stats, | 
|  | 74 | sizeof(resp->hw_stats)); | 
|  | 75 | netdev_stats_update(adapter); | 
|  | 76 | } | 
|  | 77 | } else if (compl_status != MCC_STATUS_NOT_SUPPORTED) { | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 78 | extd_status = (compl->status >> CQE_STATUS_EXTD_SHIFT) & | 
|  | 79 | CQE_STATUS_EXTD_MASK; | 
| Sathya Perla | 5f0b849 | 2009-07-27 22:52:56 +0000 | [diff] [blame] | 80 | dev_warn(&adapter->pdev->dev, | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 81 | "Error in cmd completion - opcode %d, compl %d, extd %d\n", | 
|  | 82 | compl->tag0, compl_status, extd_status); | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 83 | } | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 84 | return compl_status; | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 85 | } | 
|  | 86 |  | 
| Sathya Perla | a8f447b | 2009-06-18 00:10:27 +0000 | [diff] [blame] | 87 | /* Link state evt is a string of bytes; no need for endian swapping */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 88 | static void be_async_link_state_process(struct be_adapter *adapter, | 
| Sathya Perla | a8f447b | 2009-06-18 00:10:27 +0000 | [diff] [blame] | 89 | struct be_async_event_link_state *evt) | 
|  | 90 | { | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 91 | be_link_status_update(adapter, | 
|  | 92 | evt->port_link_status == ASYNC_EVENT_LINK_UP); | 
| Sathya Perla | a8f447b | 2009-06-18 00:10:27 +0000 | [diff] [blame] | 93 | } | 
|  | 94 |  | 
|  | 95 | static inline bool is_link_state_evt(u32 trailer) | 
|  | 96 | { | 
|  | 97 | return (((trailer >> ASYNC_TRAILER_EVENT_CODE_SHIFT) & | 
|  | 98 | ASYNC_TRAILER_EVENT_CODE_MASK) == | 
|  | 99 | ASYNC_EVENT_CODE_LINK_STATE); | 
|  | 100 | } | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 101 |  | 
| Sathya Perla | efd2e40 | 2009-07-27 22:53:10 +0000 | [diff] [blame] | 102 | static struct be_mcc_compl *be_mcc_compl_get(struct be_adapter *adapter) | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 103 | { | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 104 | struct be_queue_info *mcc_cq = &adapter->mcc_obj.cq; | 
| Sathya Perla | efd2e40 | 2009-07-27 22:53:10 +0000 | [diff] [blame] | 105 | struct be_mcc_compl *compl = queue_tail_node(mcc_cq); | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 106 |  | 
|  | 107 | if (be_mcc_compl_is_new(compl)) { | 
|  | 108 | queue_tail_inc(mcc_cq); | 
|  | 109 | return compl; | 
|  | 110 | } | 
|  | 111 | return NULL; | 
|  | 112 | } | 
|  | 113 |  | 
| Sathya Perla | 7a1e9b2 | 2010-02-17 01:35:11 +0000 | [diff] [blame] | 114 | void be_async_mcc_enable(struct be_adapter *adapter) | 
|  | 115 | { | 
|  | 116 | spin_lock_bh(&adapter->mcc_cq_lock); | 
|  | 117 |  | 
|  | 118 | be_cq_notify(adapter, adapter->mcc_obj.cq.id, true, 0); | 
|  | 119 | adapter->mcc_obj.rearm_cq = true; | 
|  | 120 |  | 
|  | 121 | spin_unlock_bh(&adapter->mcc_cq_lock); | 
|  | 122 | } | 
|  | 123 |  | 
|  | 124 | void be_async_mcc_disable(struct be_adapter *adapter) | 
|  | 125 | { | 
|  | 126 | adapter->mcc_obj.rearm_cq = false; | 
|  | 127 | } | 
|  | 128 |  | 
| Sathya Perla | f31e50a | 2010-03-02 03:56:39 -0800 | [diff] [blame] | 129 | int be_process_mcc(struct be_adapter *adapter, int *status) | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 130 | { | 
| Sathya Perla | efd2e40 | 2009-07-27 22:53:10 +0000 | [diff] [blame] | 131 | struct be_mcc_compl *compl; | 
| Sathya Perla | f31e50a | 2010-03-02 03:56:39 -0800 | [diff] [blame] | 132 | int num = 0; | 
| Sathya Perla | 7a1e9b2 | 2010-02-17 01:35:11 +0000 | [diff] [blame] | 133 | struct be_mcc_obj *mcc_obj = &adapter->mcc_obj; | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 134 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 135 | spin_lock_bh(&adapter->mcc_cq_lock); | 
|  | 136 | while ((compl = be_mcc_compl_get(adapter))) { | 
| Sathya Perla | a8f447b | 2009-06-18 00:10:27 +0000 | [diff] [blame] | 137 | if (compl->flags & CQE_FLAGS_ASYNC_MASK) { | 
|  | 138 | /* Interpret flags as an async trailer */ | 
|  | 139 | BUG_ON(!is_link_state_evt(compl->flags)); | 
|  | 140 |  | 
|  | 141 | /* Interpret compl as a async link evt */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 142 | be_async_link_state_process(adapter, | 
| Sathya Perla | a8f447b | 2009-06-18 00:10:27 +0000 | [diff] [blame] | 143 | (struct be_async_event_link_state *) compl); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 144 | } else if (compl->flags & CQE_FLAGS_COMPLETED_MASK) { | 
| Sathya Perla | f31e50a | 2010-03-02 03:56:39 -0800 | [diff] [blame] | 145 | *status = be_mcc_compl_process(adapter, compl); | 
| Sathya Perla | 7a1e9b2 | 2010-02-17 01:35:11 +0000 | [diff] [blame] | 146 | atomic_dec(&mcc_obj->q.used); | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 147 | } | 
|  | 148 | be_mcc_compl_use(compl); | 
|  | 149 | num++; | 
|  | 150 | } | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 151 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 152 | spin_unlock_bh(&adapter->mcc_cq_lock); | 
| Sathya Perla | f31e50a | 2010-03-02 03:56:39 -0800 | [diff] [blame] | 153 | return num; | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 154 | } | 
|  | 155 |  | 
| Sathya Perla | 6ac7b68 | 2009-06-18 00:05:54 +0000 | [diff] [blame] | 156 | /* Wait till no more pending mcc requests are present */ | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 157 | static int be_mcc_wait_compl(struct be_adapter *adapter) | 
| Sathya Perla | 6ac7b68 | 2009-06-18 00:05:54 +0000 | [diff] [blame] | 158 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 159 | #define mcc_timeout		120000 /* 12s timeout */ | 
| Sathya Perla | f31e50a | 2010-03-02 03:56:39 -0800 | [diff] [blame] | 160 | int i, num, status = 0; | 
|  | 161 | struct be_mcc_obj *mcc_obj = &adapter->mcc_obj; | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 162 |  | 
| Sathya Perla | f31e50a | 2010-03-02 03:56:39 -0800 | [diff] [blame] | 163 | for (i = 0; i < mcc_timeout; i++) { | 
|  | 164 | num = be_process_mcc(adapter, &status); | 
|  | 165 | if (num) | 
|  | 166 | be_cq_notify(adapter, mcc_obj->cq.id, | 
|  | 167 | mcc_obj->rearm_cq, num); | 
|  | 168 |  | 
|  | 169 | if (atomic_read(&mcc_obj->q.used) == 0) | 
| Sathya Perla | 6ac7b68 | 2009-06-18 00:05:54 +0000 | [diff] [blame] | 170 | break; | 
|  | 171 | udelay(100); | 
|  | 172 | } | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 173 | if (i == mcc_timeout) { | 
| Sathya Perla | 5f0b849 | 2009-07-27 22:52:56 +0000 | [diff] [blame] | 174 | dev_err(&adapter->pdev->dev, "mccq poll timed out\n"); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 175 | return -1; | 
|  | 176 | } | 
| Sathya Perla | f31e50a | 2010-03-02 03:56:39 -0800 | [diff] [blame] | 177 | return status; | 
| Sathya Perla | 6ac7b68 | 2009-06-18 00:05:54 +0000 | [diff] [blame] | 178 | } | 
|  | 179 |  | 
|  | 180 | /* Notify MCC requests and wait for completion */ | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 181 | static int be_mcc_notify_wait(struct be_adapter *adapter) | 
| Sathya Perla | 6ac7b68 | 2009-06-18 00:05:54 +0000 | [diff] [blame] | 182 | { | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 183 | be_mcc_notify(adapter); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 184 | return be_mcc_wait_compl(adapter); | 
| Sathya Perla | 6ac7b68 | 2009-06-18 00:05:54 +0000 | [diff] [blame] | 185 | } | 
|  | 186 |  | 
| Sathya Perla | 5f0b849 | 2009-07-27 22:52:56 +0000 | [diff] [blame] | 187 | static int be_mbox_db_ready_wait(struct be_adapter *adapter, void __iomem *db) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 188 | { | 
| Sathya Perla | f25b03a | 2010-05-30 23:34:14 +0000 | [diff] [blame] | 189 | int msecs = 0; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 190 | u32 ready; | 
|  | 191 |  | 
|  | 192 | do { | 
| Sathya Perla | cf58847 | 2010-02-14 21:22:01 +0000 | [diff] [blame] | 193 | ready = ioread32(db); | 
|  | 194 | if (ready == 0xffffffff) { | 
|  | 195 | dev_err(&adapter->pdev->dev, | 
|  | 196 | "pci slot disconnected\n"); | 
|  | 197 | return -1; | 
|  | 198 | } | 
|  | 199 |  | 
|  | 200 | ready &= MPU_MAILBOX_DB_RDY_MASK; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 201 | if (ready) | 
|  | 202 | break; | 
|  | 203 |  | 
| Sathya Perla | f25b03a | 2010-05-30 23:34:14 +0000 | [diff] [blame] | 204 | if (msecs > 4000) { | 
| Sathya Perla | 5f0b849 | 2009-07-27 22:52:56 +0000 | [diff] [blame] | 205 | dev_err(&adapter->pdev->dev, "mbox poll timed out\n"); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 206 | return -1; | 
|  | 207 | } | 
|  | 208 |  | 
| Sathya Perla | f25b03a | 2010-05-30 23:34:14 +0000 | [diff] [blame] | 209 | set_current_state(TASK_INTERRUPTIBLE); | 
|  | 210 | schedule_timeout(msecs_to_jiffies(1)); | 
|  | 211 | msecs++; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 212 | } while (true); | 
|  | 213 |  | 
|  | 214 | return 0; | 
|  | 215 | } | 
|  | 216 |  | 
|  | 217 | /* | 
|  | 218 | * Insert the mailbox address into the doorbell in two steps | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 219 | * Polls on the mbox doorbell till a command completion (or a timeout) occurs | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 220 | */ | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 221 | static int be_mbox_notify_wait(struct be_adapter *adapter) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 222 | { | 
|  | 223 | int status; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 224 | u32 val = 0; | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 225 | void __iomem *db = adapter->db + MPU_MAILBOX_DB_OFFSET; | 
|  | 226 | struct be_dma_mem *mbox_mem = &adapter->mbox_mem; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 227 | struct be_mcc_mailbox *mbox = mbox_mem->va; | 
| Sathya Perla | efd2e40 | 2009-07-27 22:53:10 +0000 | [diff] [blame] | 228 | struct be_mcc_compl *compl = &mbox->compl; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 229 |  | 
| Sathya Perla | cf58847 | 2010-02-14 21:22:01 +0000 | [diff] [blame] | 230 | /* wait for ready to be set */ | 
|  | 231 | status = be_mbox_db_ready_wait(adapter, db); | 
|  | 232 | if (status != 0) | 
|  | 233 | return status; | 
|  | 234 |  | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 235 | val |= MPU_MAILBOX_DB_HI_MASK; | 
|  | 236 | /* at bits 2 - 31 place mbox dma addr msb bits 34 - 63 */ | 
|  | 237 | val |= (upper_32_bits(mbox_mem->dma) >> 2) << 2; | 
|  | 238 | iowrite32(val, db); | 
|  | 239 |  | 
|  | 240 | /* wait for ready to be set */ | 
| Sathya Perla | 5f0b849 | 2009-07-27 22:52:56 +0000 | [diff] [blame] | 241 | status = be_mbox_db_ready_wait(adapter, db); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 242 | if (status != 0) | 
|  | 243 | return status; | 
|  | 244 |  | 
|  | 245 | val = 0; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 246 | /* at bits 2 - 31 place mbox dma addr lsb bits 4 - 33 */ | 
|  | 247 | val |= (u32)(mbox_mem->dma >> 4) << 2; | 
|  | 248 | iowrite32(val, db); | 
|  | 249 |  | 
| Sathya Perla | 5f0b849 | 2009-07-27 22:52:56 +0000 | [diff] [blame] | 250 | status = be_mbox_db_ready_wait(adapter, db); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 251 | if (status != 0) | 
|  | 252 | return status; | 
|  | 253 |  | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 254 | /* A cq entry has been made now */ | 
| Sathya Perla | efd2e40 | 2009-07-27 22:53:10 +0000 | [diff] [blame] | 255 | if (be_mcc_compl_is_new(compl)) { | 
|  | 256 | status = be_mcc_compl_process(adapter, &mbox->compl); | 
|  | 257 | be_mcc_compl_use(compl); | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 258 | if (status) | 
|  | 259 | return status; | 
|  | 260 | } else { | 
| Sathya Perla | 5f0b849 | 2009-07-27 22:52:56 +0000 | [diff] [blame] | 261 | dev_err(&adapter->pdev->dev, "invalid mailbox completion\n"); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 262 | return -1; | 
|  | 263 | } | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 264 | return 0; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 265 | } | 
|  | 266 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 267 | static int be_POST_stage_get(struct be_adapter *adapter, u16 *stage) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 268 | { | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 269 | u32 sem = ioread32(adapter->csr + MPU_EP_SEMAPHORE_OFFSET); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 270 |  | 
|  | 271 | *stage = sem & EP_SEMAPHORE_POST_STAGE_MASK; | 
|  | 272 | if ((sem >> EP_SEMAPHORE_POST_ERR_SHIFT) & EP_SEMAPHORE_POST_ERR_MASK) | 
|  | 273 | return -1; | 
|  | 274 | else | 
|  | 275 | return 0; | 
|  | 276 | } | 
|  | 277 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 278 | int be_cmd_POST(struct be_adapter *adapter) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 279 | { | 
| Sathya Perla | 43a04fdc | 2009-10-14 20:21:17 +0000 | [diff] [blame] | 280 | u16 stage; | 
|  | 281 | int status, timeout = 0; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 282 |  | 
| Sathya Perla | 43a04fdc | 2009-10-14 20:21:17 +0000 | [diff] [blame] | 283 | do { | 
|  | 284 | status = be_POST_stage_get(adapter, &stage); | 
|  | 285 | if (status) { | 
|  | 286 | dev_err(&adapter->pdev->dev, "POST error; stage=0x%x\n", | 
|  | 287 | stage); | 
|  | 288 | return -1; | 
|  | 289 | } else if (stage != POST_STAGE_ARMFW_RDY) { | 
|  | 290 | set_current_state(TASK_INTERRUPTIBLE); | 
|  | 291 | schedule_timeout(2 * HZ); | 
|  | 292 | timeout += 2; | 
|  | 293 | } else { | 
|  | 294 | return 0; | 
|  | 295 | } | 
| Sathya Perla | d938a70 | 2010-05-26 00:33:43 -0700 | [diff] [blame] | 296 | } while (timeout < 40); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 297 |  | 
| Sathya Perla | 43a04fdc | 2009-10-14 20:21:17 +0000 | [diff] [blame] | 298 | dev_err(&adapter->pdev->dev, "POST timeout; stage=0x%x\n", stage); | 
|  | 299 | return -1; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 300 | } | 
|  | 301 |  | 
|  | 302 | static inline void *embedded_payload(struct be_mcc_wrb *wrb) | 
|  | 303 | { | 
|  | 304 | return wrb->payload.embedded_payload; | 
|  | 305 | } | 
|  | 306 |  | 
|  | 307 | static inline struct be_sge *nonembedded_sgl(struct be_mcc_wrb *wrb) | 
|  | 308 | { | 
|  | 309 | return &wrb->payload.sgl[0]; | 
|  | 310 | } | 
|  | 311 |  | 
|  | 312 | /* Don't touch the hdr after it's prepared */ | 
|  | 313 | static void be_wrb_hdr_prepare(struct be_mcc_wrb *wrb, int payload_len, | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 314 | bool embedded, u8 sge_cnt, u32 opcode) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 315 | { | 
|  | 316 | if (embedded) | 
|  | 317 | wrb->embedded |= MCC_WRB_EMBEDDED_MASK; | 
|  | 318 | else | 
|  | 319 | wrb->embedded |= (sge_cnt & MCC_WRB_SGE_CNT_MASK) << | 
|  | 320 | MCC_WRB_SGE_CNT_SHIFT; | 
|  | 321 | wrb->payload_length = payload_len; | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 322 | wrb->tag0 = opcode; | 
| Sathya Perla | fa4281b | 2010-01-21 22:51:36 +0000 | [diff] [blame] | 323 | be_dws_cpu_to_le(wrb, 8); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 324 | } | 
|  | 325 |  | 
|  | 326 | /* Don't touch the hdr after it's prepared */ | 
|  | 327 | static void be_cmd_hdr_prepare(struct be_cmd_req_hdr *req_hdr, | 
|  | 328 | u8 subsystem, u8 opcode, int cmd_len) | 
|  | 329 | { | 
|  | 330 | req_hdr->opcode = opcode; | 
|  | 331 | req_hdr->subsystem = subsystem; | 
|  | 332 | req_hdr->request_length = cpu_to_le32(cmd_len - sizeof(*req_hdr)); | 
| Ajit Khaparde | 07793d3 | 2010-02-16 00:18:46 +0000 | [diff] [blame] | 333 | req_hdr->version = 0; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 334 | } | 
|  | 335 |  | 
|  | 336 | static void be_cmd_page_addrs_prepare(struct phys_addr *pages, u32 max_pages, | 
|  | 337 | struct be_dma_mem *mem) | 
|  | 338 | { | 
|  | 339 | int i, buf_pages = min(PAGES_4K_SPANNED(mem->va, mem->size), max_pages); | 
|  | 340 | u64 dma = (u64)mem->dma; | 
|  | 341 |  | 
|  | 342 | for (i = 0; i < buf_pages; i++) { | 
|  | 343 | pages[i].lo = cpu_to_le32(dma & 0xFFFFFFFF); | 
|  | 344 | pages[i].hi = cpu_to_le32(upper_32_bits(dma)); | 
|  | 345 | dma += PAGE_SIZE_4K; | 
|  | 346 | } | 
|  | 347 | } | 
|  | 348 |  | 
|  | 349 | /* Converts interrupt delay in microseconds to multiplier value */ | 
|  | 350 | static u32 eq_delay_to_mult(u32 usec_delay) | 
|  | 351 | { | 
|  | 352 | #define MAX_INTR_RATE			651042 | 
|  | 353 | const u32 round = 10; | 
|  | 354 | u32 multiplier; | 
|  | 355 |  | 
|  | 356 | if (usec_delay == 0) | 
|  | 357 | multiplier = 0; | 
|  | 358 | else { | 
|  | 359 | u32 interrupt_rate = 1000000 / usec_delay; | 
|  | 360 | /* Max delay, corresponding to the lowest interrupt rate */ | 
|  | 361 | if (interrupt_rate == 0) | 
|  | 362 | multiplier = 1023; | 
|  | 363 | else { | 
|  | 364 | multiplier = (MAX_INTR_RATE - interrupt_rate) * round; | 
|  | 365 | multiplier /= interrupt_rate; | 
|  | 366 | /* Round the multiplier to the closest value.*/ | 
|  | 367 | multiplier = (multiplier + round/2) / round; | 
|  | 368 | multiplier = min(multiplier, (u32)1023); | 
|  | 369 | } | 
|  | 370 | } | 
|  | 371 | return multiplier; | 
|  | 372 | } | 
|  | 373 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 374 | static inline struct be_mcc_wrb *wrb_from_mbox(struct be_adapter *adapter) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 375 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 376 | struct be_dma_mem *mbox_mem = &adapter->mbox_mem; | 
|  | 377 | struct be_mcc_wrb *wrb | 
|  | 378 | = &((struct be_mcc_mailbox *)(mbox_mem->va))->wrb; | 
|  | 379 | memset(wrb, 0, sizeof(*wrb)); | 
|  | 380 | return wrb; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 381 | } | 
|  | 382 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 383 | static struct be_mcc_wrb *wrb_from_mccq(struct be_adapter *adapter) | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 384 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 385 | struct be_queue_info *mccq = &adapter->mcc_obj.q; | 
|  | 386 | struct be_mcc_wrb *wrb; | 
|  | 387 |  | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 388 | if (atomic_read(&mccq->used) >= mccq->len) { | 
|  | 389 | dev_err(&adapter->pdev->dev, "Out of MCCQ wrbs\n"); | 
|  | 390 | return NULL; | 
|  | 391 | } | 
|  | 392 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 393 | wrb = queue_head_node(mccq); | 
|  | 394 | queue_head_inc(mccq); | 
|  | 395 | atomic_inc(&mccq->used); | 
|  | 396 | memset(wrb, 0, sizeof(*wrb)); | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 397 | return wrb; | 
|  | 398 | } | 
|  | 399 |  | 
| Sathya Perla | 2243e2e | 2009-11-22 22:02:03 +0000 | [diff] [blame] | 400 | /* Tell fw we're about to start firing cmds by writing a | 
|  | 401 | * special pattern across the wrb hdr; uses mbox | 
|  | 402 | */ | 
|  | 403 | int be_cmd_fw_init(struct be_adapter *adapter) | 
|  | 404 | { | 
|  | 405 | u8 *wrb; | 
|  | 406 | int status; | 
|  | 407 |  | 
|  | 408 | spin_lock(&adapter->mbox_lock); | 
|  | 409 |  | 
|  | 410 | wrb = (u8 *)wrb_from_mbox(adapter); | 
|  | 411 | *wrb++ = 0xFF; | 
|  | 412 | *wrb++ = 0x12; | 
|  | 413 | *wrb++ = 0x34; | 
|  | 414 | *wrb++ = 0xFF; | 
|  | 415 | *wrb++ = 0xFF; | 
|  | 416 | *wrb++ = 0x56; | 
|  | 417 | *wrb++ = 0x78; | 
|  | 418 | *wrb = 0xFF; | 
|  | 419 |  | 
|  | 420 | status = be_mbox_notify_wait(adapter); | 
|  | 421 |  | 
|  | 422 | spin_unlock(&adapter->mbox_lock); | 
|  | 423 | return status; | 
|  | 424 | } | 
|  | 425 |  | 
|  | 426 | /* Tell fw we're done with firing cmds by writing a | 
|  | 427 | * special pattern across the wrb hdr; uses mbox | 
|  | 428 | */ | 
|  | 429 | int be_cmd_fw_clean(struct be_adapter *adapter) | 
|  | 430 | { | 
|  | 431 | u8 *wrb; | 
|  | 432 | int status; | 
|  | 433 |  | 
| Sathya Perla | cf58847 | 2010-02-14 21:22:01 +0000 | [diff] [blame] | 434 | if (adapter->eeh_err) | 
|  | 435 | return -EIO; | 
|  | 436 |  | 
| Sathya Perla | 2243e2e | 2009-11-22 22:02:03 +0000 | [diff] [blame] | 437 | spin_lock(&adapter->mbox_lock); | 
|  | 438 |  | 
|  | 439 | wrb = (u8 *)wrb_from_mbox(adapter); | 
|  | 440 | *wrb++ = 0xFF; | 
|  | 441 | *wrb++ = 0xAA; | 
|  | 442 | *wrb++ = 0xBB; | 
|  | 443 | *wrb++ = 0xFF; | 
|  | 444 | *wrb++ = 0xFF; | 
|  | 445 | *wrb++ = 0xCC; | 
|  | 446 | *wrb++ = 0xDD; | 
|  | 447 | *wrb = 0xFF; | 
|  | 448 |  | 
|  | 449 | status = be_mbox_notify_wait(adapter); | 
|  | 450 |  | 
|  | 451 | spin_unlock(&adapter->mbox_lock); | 
|  | 452 | return status; | 
|  | 453 | } | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 454 | int be_cmd_eq_create(struct be_adapter *adapter, | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 455 | struct be_queue_info *eq, int eq_delay) | 
|  | 456 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 457 | struct be_mcc_wrb *wrb; | 
|  | 458 | struct be_cmd_req_eq_create *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 459 | struct be_dma_mem *q_mem = &eq->dma_mem; | 
|  | 460 | int status; | 
|  | 461 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 462 | spin_lock(&adapter->mbox_lock); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 463 |  | 
|  | 464 | wrb = wrb_from_mbox(adapter); | 
|  | 465 | req = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 466 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 467 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, OPCODE_COMMON_EQ_CREATE); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 468 |  | 
|  | 469 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 470 | OPCODE_COMMON_EQ_CREATE, sizeof(*req)); | 
|  | 471 |  | 
|  | 472 | req->num_pages =  cpu_to_le16(PAGES_4K_SPANNED(q_mem->va, q_mem->size)); | 
|  | 473 |  | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 474 | AMAP_SET_BITS(struct amap_eq_context, valid, req->context, 1); | 
|  | 475 | /* 4byte eqe*/ | 
|  | 476 | AMAP_SET_BITS(struct amap_eq_context, size, req->context, 0); | 
|  | 477 | AMAP_SET_BITS(struct amap_eq_context, count, req->context, | 
|  | 478 | __ilog2_u32(eq->len/256)); | 
|  | 479 | AMAP_SET_BITS(struct amap_eq_context, delaymult, req->context, | 
|  | 480 | eq_delay_to_mult(eq_delay)); | 
|  | 481 | be_dws_cpu_to_le(req->context, sizeof(req->context)); | 
|  | 482 |  | 
|  | 483 | be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem); | 
|  | 484 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 485 | status = be_mbox_notify_wait(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 486 | if (!status) { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 487 | struct be_cmd_resp_eq_create *resp = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 488 | eq->id = le16_to_cpu(resp->eq_id); | 
|  | 489 | eq->created = true; | 
|  | 490 | } | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 491 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 492 | spin_unlock(&adapter->mbox_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 493 | return status; | 
|  | 494 | } | 
|  | 495 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 496 | /* Uses mbox */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 497 | int be_cmd_mac_addr_query(struct be_adapter *adapter, u8 *mac_addr, | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 498 | u8 type, bool permanent, u32 if_handle) | 
|  | 499 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 500 | struct be_mcc_wrb *wrb; | 
|  | 501 | struct be_cmd_req_mac_query *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 502 | int status; | 
|  | 503 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 504 | spin_lock(&adapter->mbox_lock); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 505 |  | 
|  | 506 | wrb = wrb_from_mbox(adapter); | 
|  | 507 | req = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 508 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 509 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 510 | OPCODE_COMMON_NTWK_MAC_QUERY); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 511 |  | 
|  | 512 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 513 | OPCODE_COMMON_NTWK_MAC_QUERY, sizeof(*req)); | 
|  | 514 |  | 
|  | 515 | req->type = type; | 
|  | 516 | if (permanent) { | 
|  | 517 | req->permanent = 1; | 
|  | 518 | } else { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 519 | req->if_id = cpu_to_le16((u16) if_handle); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 520 | req->permanent = 0; | 
|  | 521 | } | 
|  | 522 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 523 | status = be_mbox_notify_wait(adapter); | 
|  | 524 | if (!status) { | 
|  | 525 | struct be_cmd_resp_mac_query *resp = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 526 | memcpy(mac_addr, resp->mac.addr, ETH_ALEN); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 527 | } | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 528 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 529 | spin_unlock(&adapter->mbox_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 530 | return status; | 
|  | 531 | } | 
|  | 532 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 533 | /* Uses synchronous MCCQ */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 534 | int be_cmd_pmac_add(struct be_adapter *adapter, u8 *mac_addr, | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 535 | u32 if_id, u32 *pmac_id) | 
|  | 536 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 537 | struct be_mcc_wrb *wrb; | 
|  | 538 | struct be_cmd_req_pmac_add *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 539 | int status; | 
|  | 540 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 541 | spin_lock_bh(&adapter->mcc_lock); | 
|  | 542 |  | 
|  | 543 | wrb = wrb_from_mccq(adapter); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 544 | if (!wrb) { | 
|  | 545 | status = -EBUSY; | 
|  | 546 | goto err; | 
|  | 547 | } | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 548 | req = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 549 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 550 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 551 | OPCODE_COMMON_NTWK_PMAC_ADD); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 552 |  | 
|  | 553 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 554 | OPCODE_COMMON_NTWK_PMAC_ADD, sizeof(*req)); | 
|  | 555 |  | 
|  | 556 | req->if_id = cpu_to_le32(if_id); | 
|  | 557 | memcpy(req->mac_address, mac_addr, ETH_ALEN); | 
|  | 558 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 559 | status = be_mcc_notify_wait(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 560 | if (!status) { | 
|  | 561 | struct be_cmd_resp_pmac_add *resp = embedded_payload(wrb); | 
|  | 562 | *pmac_id = le32_to_cpu(resp->pmac_id); | 
|  | 563 | } | 
|  | 564 |  | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 565 | err: | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 566 | spin_unlock_bh(&adapter->mcc_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 567 | return status; | 
|  | 568 | } | 
|  | 569 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 570 | /* Uses synchronous MCCQ */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 571 | int be_cmd_pmac_del(struct be_adapter *adapter, u32 if_id, u32 pmac_id) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 572 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 573 | struct be_mcc_wrb *wrb; | 
|  | 574 | struct be_cmd_req_pmac_del *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 575 | int status; | 
|  | 576 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 577 | spin_lock_bh(&adapter->mcc_lock); | 
|  | 578 |  | 
|  | 579 | wrb = wrb_from_mccq(adapter); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 580 | if (!wrb) { | 
|  | 581 | status = -EBUSY; | 
|  | 582 | goto err; | 
|  | 583 | } | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 584 | req = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 585 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 586 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 587 | OPCODE_COMMON_NTWK_PMAC_DEL); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 588 |  | 
|  | 589 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 590 | OPCODE_COMMON_NTWK_PMAC_DEL, sizeof(*req)); | 
|  | 591 |  | 
|  | 592 | req->if_id = cpu_to_le32(if_id); | 
|  | 593 | req->pmac_id = cpu_to_le32(pmac_id); | 
|  | 594 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 595 | status = be_mcc_notify_wait(adapter); | 
|  | 596 |  | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 597 | err: | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 598 | spin_unlock_bh(&adapter->mcc_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 599 | return status; | 
|  | 600 | } | 
|  | 601 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 602 | /* Uses Mbox */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 603 | int be_cmd_cq_create(struct be_adapter *adapter, | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 604 | struct be_queue_info *cq, struct be_queue_info *eq, | 
|  | 605 | bool sol_evts, bool no_delay, int coalesce_wm) | 
|  | 606 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 607 | struct be_mcc_wrb *wrb; | 
|  | 608 | struct be_cmd_req_cq_create *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 609 | struct be_dma_mem *q_mem = &cq->dma_mem; | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 610 | void *ctxt; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 611 | int status; | 
|  | 612 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 613 | spin_lock(&adapter->mbox_lock); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 614 |  | 
|  | 615 | wrb = wrb_from_mbox(adapter); | 
|  | 616 | req = embedded_payload(wrb); | 
|  | 617 | ctxt = &req->context; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 618 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 619 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 620 | OPCODE_COMMON_CQ_CREATE); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 621 |  | 
|  | 622 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 623 | OPCODE_COMMON_CQ_CREATE, sizeof(*req)); | 
|  | 624 |  | 
|  | 625 | req->num_pages =  cpu_to_le16(PAGES_4K_SPANNED(q_mem->va, q_mem->size)); | 
|  | 626 |  | 
|  | 627 | AMAP_SET_BITS(struct amap_cq_context, coalescwm, ctxt, coalesce_wm); | 
|  | 628 | AMAP_SET_BITS(struct amap_cq_context, nodelay, ctxt, no_delay); | 
|  | 629 | AMAP_SET_BITS(struct amap_cq_context, count, ctxt, | 
|  | 630 | __ilog2_u32(cq->len/256)); | 
|  | 631 | AMAP_SET_BITS(struct amap_cq_context, valid, ctxt, 1); | 
|  | 632 | AMAP_SET_BITS(struct amap_cq_context, solevent, ctxt, sol_evts); | 
|  | 633 | AMAP_SET_BITS(struct amap_cq_context, eventable, ctxt, 1); | 
|  | 634 | AMAP_SET_BITS(struct amap_cq_context, eqid, ctxt, eq->id); | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 635 | AMAP_SET_BITS(struct amap_cq_context, armed, ctxt, 1); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 636 | be_dws_cpu_to_le(ctxt, sizeof(req->context)); | 
|  | 637 |  | 
|  | 638 | be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem); | 
|  | 639 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 640 | status = be_mbox_notify_wait(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 641 | if (!status) { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 642 | struct be_cmd_resp_cq_create *resp = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 643 | cq->id = le16_to_cpu(resp->cq_id); | 
|  | 644 | cq->created = true; | 
|  | 645 | } | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 646 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 647 | spin_unlock(&adapter->mbox_lock); | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 648 |  | 
|  | 649 | return status; | 
|  | 650 | } | 
|  | 651 |  | 
|  | 652 | static u32 be_encoded_q_len(int q_len) | 
|  | 653 | { | 
|  | 654 | u32 len_encoded = fls(q_len); /* log2(len) + 1 */ | 
|  | 655 | if (len_encoded == 16) | 
|  | 656 | len_encoded = 0; | 
|  | 657 | return len_encoded; | 
|  | 658 | } | 
|  | 659 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 660 | int be_cmd_mccq_create(struct be_adapter *adapter, | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 661 | struct be_queue_info *mccq, | 
|  | 662 | struct be_queue_info *cq) | 
|  | 663 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 664 | struct be_mcc_wrb *wrb; | 
|  | 665 | struct be_cmd_req_mcc_create *req; | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 666 | struct be_dma_mem *q_mem = &mccq->dma_mem; | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 667 | void *ctxt; | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 668 | int status; | 
|  | 669 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 670 | spin_lock(&adapter->mbox_lock); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 671 |  | 
|  | 672 | wrb = wrb_from_mbox(adapter); | 
|  | 673 | req = embedded_payload(wrb); | 
|  | 674 | ctxt = &req->context; | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 675 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 676 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 677 | OPCODE_COMMON_MCC_CREATE); | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 678 |  | 
|  | 679 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 680 | OPCODE_COMMON_MCC_CREATE, sizeof(*req)); | 
|  | 681 |  | 
| Ajit Khaparde | d4a2ac3 | 2010-03-11 01:35:59 +0000 | [diff] [blame] | 682 | req->num_pages = cpu_to_le16(PAGES_4K_SPANNED(q_mem->va, q_mem->size)); | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 683 |  | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 684 | AMAP_SET_BITS(struct amap_mcc_context, valid, ctxt, 1); | 
|  | 685 | AMAP_SET_BITS(struct amap_mcc_context, ring_size, ctxt, | 
|  | 686 | be_encoded_q_len(mccq->len)); | 
|  | 687 | AMAP_SET_BITS(struct amap_mcc_context, cq_id, ctxt, cq->id); | 
|  | 688 |  | 
|  | 689 | be_dws_cpu_to_le(ctxt, sizeof(req->context)); | 
|  | 690 |  | 
|  | 691 | be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem); | 
|  | 692 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 693 | status = be_mbox_notify_wait(adapter); | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 694 | if (!status) { | 
|  | 695 | struct be_cmd_resp_mcc_create *resp = embedded_payload(wrb); | 
|  | 696 | mccq->id = le16_to_cpu(resp->id); | 
|  | 697 | mccq->created = true; | 
|  | 698 | } | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 699 | spin_unlock(&adapter->mbox_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 700 |  | 
|  | 701 | return status; | 
|  | 702 | } | 
|  | 703 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 704 | int be_cmd_txq_create(struct be_adapter *adapter, | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 705 | struct be_queue_info *txq, | 
|  | 706 | struct be_queue_info *cq) | 
|  | 707 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 708 | struct be_mcc_wrb *wrb; | 
|  | 709 | struct be_cmd_req_eth_tx_create *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 710 | struct be_dma_mem *q_mem = &txq->dma_mem; | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 711 | void *ctxt; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 712 | int status; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 713 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 714 | spin_lock(&adapter->mbox_lock); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 715 |  | 
|  | 716 | wrb = wrb_from_mbox(adapter); | 
|  | 717 | req = embedded_payload(wrb); | 
|  | 718 | ctxt = &req->context; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 719 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 720 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 721 | OPCODE_ETH_TX_CREATE); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 722 |  | 
|  | 723 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH, OPCODE_ETH_TX_CREATE, | 
|  | 724 | sizeof(*req)); | 
|  | 725 |  | 
|  | 726 | req->num_pages = PAGES_4K_SPANNED(q_mem->va, q_mem->size); | 
|  | 727 | req->ulp_num = BE_ULP1_NUM; | 
|  | 728 | req->type = BE_ETH_TX_RING_TYPE_STANDARD; | 
|  | 729 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 730 | AMAP_SET_BITS(struct amap_tx_context, tx_ring_size, ctxt, | 
|  | 731 | be_encoded_q_len(txq->len)); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 732 | AMAP_SET_BITS(struct amap_tx_context, ctx_valid, ctxt, 1); | 
|  | 733 | AMAP_SET_BITS(struct amap_tx_context, cq_id_send, ctxt, cq->id); | 
|  | 734 |  | 
|  | 735 | be_dws_cpu_to_le(ctxt, sizeof(req->context)); | 
|  | 736 |  | 
|  | 737 | be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem); | 
|  | 738 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 739 | status = be_mbox_notify_wait(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 740 | if (!status) { | 
|  | 741 | struct be_cmd_resp_eth_tx_create *resp = embedded_payload(wrb); | 
|  | 742 | txq->id = le16_to_cpu(resp->cid); | 
|  | 743 | txq->created = true; | 
|  | 744 | } | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 745 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 746 | spin_unlock(&adapter->mbox_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 747 |  | 
|  | 748 | return status; | 
|  | 749 | } | 
|  | 750 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 751 | /* Uses mbox */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 752 | int be_cmd_rxq_create(struct be_adapter *adapter, | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 753 | struct be_queue_info *rxq, u16 cq_id, u16 frag_size, | 
|  | 754 | u16 max_frame_size, u32 if_id, u32 rss) | 
|  | 755 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 756 | struct be_mcc_wrb *wrb; | 
|  | 757 | struct be_cmd_req_eth_rx_create *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 758 | struct be_dma_mem *q_mem = &rxq->dma_mem; | 
|  | 759 | int status; | 
|  | 760 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 761 | spin_lock(&adapter->mbox_lock); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 762 |  | 
|  | 763 | wrb = wrb_from_mbox(adapter); | 
|  | 764 | req = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 765 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 766 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 767 | OPCODE_ETH_RX_CREATE); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 768 |  | 
|  | 769 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH, OPCODE_ETH_RX_CREATE, | 
|  | 770 | sizeof(*req)); | 
|  | 771 |  | 
|  | 772 | req->cq_id = cpu_to_le16(cq_id); | 
|  | 773 | req->frag_size = fls(frag_size) - 1; | 
|  | 774 | req->num_pages = 2; | 
|  | 775 | be_cmd_page_addrs_prepare(req->pages, ARRAY_SIZE(req->pages), q_mem); | 
|  | 776 | req->interface_id = cpu_to_le32(if_id); | 
|  | 777 | req->max_frame_size = cpu_to_le16(max_frame_size); | 
|  | 778 | req->rss_queue = cpu_to_le32(rss); | 
|  | 779 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 780 | status = be_mbox_notify_wait(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 781 | if (!status) { | 
|  | 782 | struct be_cmd_resp_eth_rx_create *resp = embedded_payload(wrb); | 
|  | 783 | rxq->id = le16_to_cpu(resp->id); | 
|  | 784 | rxq->created = true; | 
|  | 785 | } | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 786 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 787 | spin_unlock(&adapter->mbox_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 788 |  | 
|  | 789 | return status; | 
|  | 790 | } | 
|  | 791 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 792 | /* Generic destroyer function for all types of queues | 
|  | 793 | * Uses Mbox | 
|  | 794 | */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 795 | int be_cmd_q_destroy(struct be_adapter *adapter, struct be_queue_info *q, | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 796 | int queue_type) | 
|  | 797 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 798 | struct be_mcc_wrb *wrb; | 
|  | 799 | struct be_cmd_req_q_destroy *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 800 | u8 subsys = 0, opcode = 0; | 
|  | 801 | int status; | 
|  | 802 |  | 
| Sathya Perla | cf58847 | 2010-02-14 21:22:01 +0000 | [diff] [blame] | 803 | if (adapter->eeh_err) | 
|  | 804 | return -EIO; | 
|  | 805 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 806 | spin_lock(&adapter->mbox_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 807 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 808 | wrb = wrb_from_mbox(adapter); | 
|  | 809 | req = embedded_payload(wrb); | 
|  | 810 |  | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 811 | switch (queue_type) { | 
|  | 812 | case QTYPE_EQ: | 
|  | 813 | subsys = CMD_SUBSYSTEM_COMMON; | 
|  | 814 | opcode = OPCODE_COMMON_EQ_DESTROY; | 
|  | 815 | break; | 
|  | 816 | case QTYPE_CQ: | 
|  | 817 | subsys = CMD_SUBSYSTEM_COMMON; | 
|  | 818 | opcode = OPCODE_COMMON_CQ_DESTROY; | 
|  | 819 | break; | 
|  | 820 | case QTYPE_TXQ: | 
|  | 821 | subsys = CMD_SUBSYSTEM_ETH; | 
|  | 822 | opcode = OPCODE_ETH_TX_DESTROY; | 
|  | 823 | break; | 
|  | 824 | case QTYPE_RXQ: | 
|  | 825 | subsys = CMD_SUBSYSTEM_ETH; | 
|  | 826 | opcode = OPCODE_ETH_RX_DESTROY; | 
|  | 827 | break; | 
| Sathya Perla | 5fb379e | 2009-06-18 00:02:59 +0000 | [diff] [blame] | 828 | case QTYPE_MCCQ: | 
|  | 829 | subsys = CMD_SUBSYSTEM_COMMON; | 
|  | 830 | opcode = OPCODE_COMMON_MCC_DESTROY; | 
|  | 831 | break; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 832 | default: | 
| Sathya Perla | 5f0b849 | 2009-07-27 22:52:56 +0000 | [diff] [blame] | 833 | BUG(); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 834 | } | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 835 |  | 
|  | 836 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, opcode); | 
|  | 837 |  | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 838 | be_cmd_hdr_prepare(&req->hdr, subsys, opcode, sizeof(*req)); | 
|  | 839 | req->id = cpu_to_le16(q->id); | 
|  | 840 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 841 | status = be_mbox_notify_wait(adapter); | 
| Sathya Perla | 5f0b849 | 2009-07-27 22:52:56 +0000 | [diff] [blame] | 842 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 843 | spin_unlock(&adapter->mbox_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 844 |  | 
|  | 845 | return status; | 
|  | 846 | } | 
|  | 847 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 848 | /* Create an rx filtering policy configuration on an i/f | 
|  | 849 | * Uses mbox | 
|  | 850 | */ | 
| Sathya Perla | 73d540f | 2009-10-14 20:20:42 +0000 | [diff] [blame] | 851 | int be_cmd_if_create(struct be_adapter *adapter, u32 cap_flags, u32 en_flags, | 
| Sarveshwar Bandi | ba343c7 | 2010-03-31 02:56:12 +0000 | [diff] [blame] | 852 | u8 *mac, bool pmac_invalid, u32 *if_handle, u32 *pmac_id, | 
|  | 853 | u32 domain) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 854 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 855 | struct be_mcc_wrb *wrb; | 
|  | 856 | struct be_cmd_req_if_create *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 857 | int status; | 
|  | 858 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 859 | spin_lock(&adapter->mbox_lock); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 860 |  | 
|  | 861 | wrb = wrb_from_mbox(adapter); | 
|  | 862 | req = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 863 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 864 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 865 | OPCODE_COMMON_NTWK_INTERFACE_CREATE); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 866 |  | 
|  | 867 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 868 | OPCODE_COMMON_NTWK_INTERFACE_CREATE, sizeof(*req)); | 
|  | 869 |  | 
| Sarveshwar Bandi | ba343c7 | 2010-03-31 02:56:12 +0000 | [diff] [blame] | 870 | req->hdr.domain = domain; | 
| Sathya Perla | 73d540f | 2009-10-14 20:20:42 +0000 | [diff] [blame] | 871 | req->capability_flags = cpu_to_le32(cap_flags); | 
|  | 872 | req->enable_flags = cpu_to_le32(en_flags); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 873 | req->pmac_invalid = pmac_invalid; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 874 | if (!pmac_invalid) | 
|  | 875 | memcpy(req->mac_addr, mac, ETH_ALEN); | 
|  | 876 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 877 | status = be_mbox_notify_wait(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 878 | if (!status) { | 
|  | 879 | struct be_cmd_resp_if_create *resp = embedded_payload(wrb); | 
|  | 880 | *if_handle = le32_to_cpu(resp->interface_id); | 
|  | 881 | if (!pmac_invalid) | 
|  | 882 | *pmac_id = le32_to_cpu(resp->pmac_id); | 
|  | 883 | } | 
|  | 884 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 885 | spin_unlock(&adapter->mbox_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 886 | return status; | 
|  | 887 | } | 
|  | 888 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 889 | /* Uses mbox */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 890 | int be_cmd_if_destroy(struct be_adapter *adapter, u32 interface_id) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 891 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 892 | struct be_mcc_wrb *wrb; | 
|  | 893 | struct be_cmd_req_if_destroy *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 894 | int status; | 
|  | 895 |  | 
| Sathya Perla | cf58847 | 2010-02-14 21:22:01 +0000 | [diff] [blame] | 896 | if (adapter->eeh_err) | 
|  | 897 | return -EIO; | 
|  | 898 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 899 | spin_lock(&adapter->mbox_lock); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 900 |  | 
|  | 901 | wrb = wrb_from_mbox(adapter); | 
|  | 902 | req = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 903 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 904 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 905 | OPCODE_COMMON_NTWK_INTERFACE_DESTROY); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 906 |  | 
|  | 907 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 908 | OPCODE_COMMON_NTWK_INTERFACE_DESTROY, sizeof(*req)); | 
|  | 909 |  | 
|  | 910 | req->interface_id = cpu_to_le32(interface_id); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 911 |  | 
|  | 912 | status = be_mbox_notify_wait(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 913 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 914 | spin_unlock(&adapter->mbox_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 915 |  | 
|  | 916 | return status; | 
|  | 917 | } | 
|  | 918 |  | 
|  | 919 | /* Get stats is a non embedded command: the request is not embedded inside | 
|  | 920 | * WRB but is a separate dma memory block | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 921 | * Uses asynchronous MCC | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 922 | */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 923 | int be_cmd_get_stats(struct be_adapter *adapter, struct be_dma_mem *nonemb_cmd) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 924 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 925 | struct be_mcc_wrb *wrb; | 
|  | 926 | struct be_cmd_req_get_stats *req; | 
|  | 927 | struct be_sge *sge; | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 928 | int status = 0; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 929 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 930 | spin_lock_bh(&adapter->mcc_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 931 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 932 | wrb = wrb_from_mccq(adapter); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 933 | if (!wrb) { | 
|  | 934 | status = -EBUSY; | 
|  | 935 | goto err; | 
|  | 936 | } | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 937 | req = nonemb_cmd->va; | 
|  | 938 | sge = nonembedded_sgl(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 939 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 940 | be_wrb_hdr_prepare(wrb, sizeof(*req), false, 1, | 
|  | 941 | OPCODE_ETH_GET_STATISTICS); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 942 |  | 
|  | 943 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH, | 
|  | 944 | OPCODE_ETH_GET_STATISTICS, sizeof(*req)); | 
|  | 945 | sge->pa_hi = cpu_to_le32(upper_32_bits(nonemb_cmd->dma)); | 
|  | 946 | sge->pa_lo = cpu_to_le32(nonemb_cmd->dma & 0xFFFFFFFF); | 
|  | 947 | sge->len = cpu_to_le32(nonemb_cmd->size); | 
|  | 948 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 949 | be_mcc_notify(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 950 |  | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 951 | err: | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 952 | spin_unlock_bh(&adapter->mcc_lock); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 953 | return status; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 954 | } | 
|  | 955 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 956 | /* Uses synchronous mcc */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 957 | int be_cmd_link_status_query(struct be_adapter *adapter, | 
| Sarveshwar Bandi | 0388f25 | 2009-10-28 04:15:20 -0700 | [diff] [blame] | 958 | bool *link_up, u8 *mac_speed, u16 *link_speed) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 959 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 960 | struct be_mcc_wrb *wrb; | 
|  | 961 | struct be_cmd_req_link_status *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 962 | int status; | 
|  | 963 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 964 | spin_lock_bh(&adapter->mcc_lock); | 
|  | 965 |  | 
|  | 966 | wrb = wrb_from_mccq(adapter); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 967 | if (!wrb) { | 
|  | 968 | status = -EBUSY; | 
|  | 969 | goto err; | 
|  | 970 | } | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 971 | req = embedded_payload(wrb); | 
| Sathya Perla | a8f447b | 2009-06-18 00:10:27 +0000 | [diff] [blame] | 972 |  | 
|  | 973 | *link_up = false; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 974 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 975 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 976 | OPCODE_COMMON_NTWK_LINK_STATUS_QUERY); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 977 |  | 
|  | 978 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 979 | OPCODE_COMMON_NTWK_LINK_STATUS_QUERY, sizeof(*req)); | 
|  | 980 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 981 | status = be_mcc_notify_wait(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 982 | if (!status) { | 
|  | 983 | struct be_cmd_resp_link_status *resp = embedded_payload(wrb); | 
| Sarveshwar Bandi | 0388f25 | 2009-10-28 04:15:20 -0700 | [diff] [blame] | 984 | if (resp->mac_speed != PHY_LINK_SPEED_ZERO) { | 
| Sathya Perla | a8f447b | 2009-06-18 00:10:27 +0000 | [diff] [blame] | 985 | *link_up = true; | 
| Sarveshwar Bandi | 0388f25 | 2009-10-28 04:15:20 -0700 | [diff] [blame] | 986 | *link_speed = le16_to_cpu(resp->link_speed); | 
|  | 987 | *mac_speed = resp->mac_speed; | 
|  | 988 | } | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 989 | } | 
|  | 990 |  | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 991 | err: | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 992 | spin_unlock_bh(&adapter->mcc_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 993 | return status; | 
|  | 994 | } | 
|  | 995 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 996 | /* Uses Mbox */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 997 | int be_cmd_get_fw_ver(struct be_adapter *adapter, char *fw_ver) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 998 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 999 | struct be_mcc_wrb *wrb; | 
|  | 1000 | struct be_cmd_req_get_fw_version *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1001 | int status; | 
|  | 1002 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 1003 | spin_lock(&adapter->mbox_lock); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1004 |  | 
|  | 1005 | wrb = wrb_from_mbox(adapter); | 
|  | 1006 | req = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1007 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 1008 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 1009 | OPCODE_COMMON_GET_FW_VERSION); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1010 |  | 
|  | 1011 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 1012 | OPCODE_COMMON_GET_FW_VERSION, sizeof(*req)); | 
|  | 1013 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1014 | status = be_mbox_notify_wait(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1015 | if (!status) { | 
|  | 1016 | struct be_cmd_resp_get_fw_version *resp = embedded_payload(wrb); | 
|  | 1017 | strncpy(fw_ver, resp->firmware_version_string, FW_VER_LEN); | 
|  | 1018 | } | 
|  | 1019 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 1020 | spin_unlock(&adapter->mbox_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1021 | return status; | 
|  | 1022 | } | 
|  | 1023 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1024 | /* set the EQ delay interval of an EQ to specified value | 
|  | 1025 | * Uses async mcc | 
|  | 1026 | */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 1027 | int be_cmd_modify_eqd(struct be_adapter *adapter, u32 eq_id, u32 eqd) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1028 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1029 | struct be_mcc_wrb *wrb; | 
|  | 1030 | struct be_cmd_req_modify_eq_delay *req; | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1031 | int status = 0; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1032 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1033 | spin_lock_bh(&adapter->mcc_lock); | 
|  | 1034 |  | 
|  | 1035 | wrb = wrb_from_mccq(adapter); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1036 | if (!wrb) { | 
|  | 1037 | status = -EBUSY; | 
|  | 1038 | goto err; | 
|  | 1039 | } | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1040 | req = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1041 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 1042 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 1043 | OPCODE_COMMON_MODIFY_EQ_DELAY); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1044 |  | 
|  | 1045 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 1046 | OPCODE_COMMON_MODIFY_EQ_DELAY, sizeof(*req)); | 
|  | 1047 |  | 
|  | 1048 | req->num_eq = cpu_to_le32(1); | 
|  | 1049 | req->delay[0].eq_id = cpu_to_le32(eq_id); | 
|  | 1050 | req->delay[0].phase = 0; | 
|  | 1051 | req->delay[0].delay_multiplier = cpu_to_le32(eqd); | 
|  | 1052 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1053 | be_mcc_notify(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1054 |  | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1055 | err: | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1056 | spin_unlock_bh(&adapter->mcc_lock); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1057 | return status; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1058 | } | 
|  | 1059 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1060 | /* Uses sycnhronous mcc */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 1061 | int be_cmd_vlan_config(struct be_adapter *adapter, u32 if_id, u16 *vtag_array, | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1062 | u32 num, bool untagged, bool promiscuous) | 
|  | 1063 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1064 | struct be_mcc_wrb *wrb; | 
|  | 1065 | struct be_cmd_req_vlan_config *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1066 | int status; | 
|  | 1067 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1068 | spin_lock_bh(&adapter->mcc_lock); | 
|  | 1069 |  | 
|  | 1070 | wrb = wrb_from_mccq(adapter); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1071 | if (!wrb) { | 
|  | 1072 | status = -EBUSY; | 
|  | 1073 | goto err; | 
|  | 1074 | } | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1075 | req = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1076 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 1077 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 1078 | OPCODE_COMMON_NTWK_VLAN_CONFIG); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1079 |  | 
|  | 1080 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 1081 | OPCODE_COMMON_NTWK_VLAN_CONFIG, sizeof(*req)); | 
|  | 1082 |  | 
|  | 1083 | req->interface_id = if_id; | 
|  | 1084 | req->promiscuous = promiscuous; | 
|  | 1085 | req->untagged = untagged; | 
|  | 1086 | req->num_vlan = num; | 
|  | 1087 | if (!promiscuous) { | 
|  | 1088 | memcpy(req->normal_vlan, vtag_array, | 
|  | 1089 | req->num_vlan * sizeof(vtag_array[0])); | 
|  | 1090 | } | 
|  | 1091 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1092 | status = be_mcc_notify_wait(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1093 |  | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1094 | err: | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1095 | spin_unlock_bh(&adapter->mcc_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1096 | return status; | 
|  | 1097 | } | 
|  | 1098 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1099 | /* Uses MCC for this command as it may be called in BH context | 
|  | 1100 | * Uses synchronous mcc | 
|  | 1101 | */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 1102 | int be_cmd_promiscuous_config(struct be_adapter *adapter, u8 port_num, bool en) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1103 | { | 
| Sathya Perla | 6ac7b68 | 2009-06-18 00:05:54 +0000 | [diff] [blame] | 1104 | struct be_mcc_wrb *wrb; | 
|  | 1105 | struct be_cmd_req_promiscuous_config *req; | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1106 | int status; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1107 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 1108 | spin_lock_bh(&adapter->mcc_lock); | 
| Sathya Perla | 6ac7b68 | 2009-06-18 00:05:54 +0000 | [diff] [blame] | 1109 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1110 | wrb = wrb_from_mccq(adapter); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1111 | if (!wrb) { | 
|  | 1112 | status = -EBUSY; | 
|  | 1113 | goto err; | 
|  | 1114 | } | 
| Sathya Perla | 6ac7b68 | 2009-06-18 00:05:54 +0000 | [diff] [blame] | 1115 | req = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1116 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 1117 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, OPCODE_ETH_PROMISCUOUS); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1118 |  | 
|  | 1119 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH, | 
|  | 1120 | OPCODE_ETH_PROMISCUOUS, sizeof(*req)); | 
|  | 1121 |  | 
| Sathya Perla | 69d7ce7 | 2010-04-11 22:35:27 +0000 | [diff] [blame] | 1122 | /* In FW versions X.102.149/X.101.487 and later, | 
|  | 1123 | * the port setting associated only with the | 
|  | 1124 | * issuing pci function will take effect | 
|  | 1125 | */ | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1126 | if (port_num) | 
|  | 1127 | req->port1_promiscuous = en; | 
|  | 1128 | else | 
|  | 1129 | req->port0_promiscuous = en; | 
|  | 1130 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1131 | status = be_mcc_notify_wait(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1132 |  | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1133 | err: | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 1134 | spin_unlock_bh(&adapter->mcc_lock); | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1135 | return status; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1136 | } | 
|  | 1137 |  | 
| Sathya Perla | 6ac7b68 | 2009-06-18 00:05:54 +0000 | [diff] [blame] | 1138 | /* | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1139 | * Uses MCC for this command as it may be called in BH context | 
| Sathya Perla | 6ac7b68 | 2009-06-18 00:05:54 +0000 | [diff] [blame] | 1140 | * (mc == NULL) => multicast promiscous | 
|  | 1141 | */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 1142 | int be_cmd_multicast_set(struct be_adapter *adapter, u32 if_id, | 
| Jiri Pirko | 0ddf477 | 2010-02-20 00:13:58 +0000 | [diff] [blame] | 1143 | struct net_device *netdev, struct be_dma_mem *mem) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1144 | { | 
| Sathya Perla | 6ac7b68 | 2009-06-18 00:05:54 +0000 | [diff] [blame] | 1145 | struct be_mcc_wrb *wrb; | 
| Sathya Perla | e7b909a | 2009-11-22 22:01:10 +0000 | [diff] [blame] | 1146 | struct be_cmd_req_mcast_mac_config *req = mem->va; | 
|  | 1147 | struct be_sge *sge; | 
|  | 1148 | int status; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1149 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 1150 | spin_lock_bh(&adapter->mcc_lock); | 
| Sathya Perla | 6ac7b68 | 2009-06-18 00:05:54 +0000 | [diff] [blame] | 1151 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1152 | wrb = wrb_from_mccq(adapter); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1153 | if (!wrb) { | 
|  | 1154 | status = -EBUSY; | 
|  | 1155 | goto err; | 
|  | 1156 | } | 
| Sathya Perla | e7b909a | 2009-11-22 22:01:10 +0000 | [diff] [blame] | 1157 | sge = nonembedded_sgl(wrb); | 
|  | 1158 | memset(req, 0, sizeof(*req)); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1159 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 1160 | be_wrb_hdr_prepare(wrb, sizeof(*req), false, 1, | 
|  | 1161 | OPCODE_COMMON_NTWK_MULTICAST_SET); | 
| Sathya Perla | e7b909a | 2009-11-22 22:01:10 +0000 | [diff] [blame] | 1162 | sge->pa_hi = cpu_to_le32(upper_32_bits(mem->dma)); | 
|  | 1163 | sge->pa_lo = cpu_to_le32(mem->dma & 0xFFFFFFFF); | 
|  | 1164 | sge->len = cpu_to_le32(mem->size); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1165 |  | 
|  | 1166 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 1167 | OPCODE_COMMON_NTWK_MULTICAST_SET, sizeof(*req)); | 
|  | 1168 |  | 
|  | 1169 | req->interface_id = if_id; | 
| Jiri Pirko | 0ddf477 | 2010-02-20 00:13:58 +0000 | [diff] [blame] | 1170 | if (netdev) { | 
| Sathya Perla | 24307ee | 2009-06-18 00:09:25 +0000 | [diff] [blame] | 1171 | int i; | 
| Jiri Pirko | 22bedad | 2010-04-01 21:22:57 +0000 | [diff] [blame] | 1172 | struct netdev_hw_addr *ha; | 
| Sathya Perla | 24307ee | 2009-06-18 00:09:25 +0000 | [diff] [blame] | 1173 |  | 
| Jiri Pirko | 0ddf477 | 2010-02-20 00:13:58 +0000 | [diff] [blame] | 1174 | req->num_mac = cpu_to_le16(netdev_mc_count(netdev)); | 
| Sathya Perla | 24307ee | 2009-06-18 00:09:25 +0000 | [diff] [blame] | 1175 |  | 
| Jiri Pirko | 0ddf477 | 2010-02-20 00:13:58 +0000 | [diff] [blame] | 1176 | i = 0; | 
| Jiri Pirko | 22bedad | 2010-04-01 21:22:57 +0000 | [diff] [blame] | 1177 | netdev_for_each_mc_addr(ha, netdev) | 
|  | 1178 | memcpy(req->mac[i].byte, ha->addr, ETH_ALEN); | 
| Sathya Perla | 24307ee | 2009-06-18 00:09:25 +0000 | [diff] [blame] | 1179 | } else { | 
|  | 1180 | req->promiscuous = 1; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1181 | } | 
|  | 1182 |  | 
| Sathya Perla | e7b909a | 2009-11-22 22:01:10 +0000 | [diff] [blame] | 1183 | status = be_mcc_notify_wait(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1184 |  | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1185 | err: | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 1186 | spin_unlock_bh(&adapter->mcc_lock); | 
| Sathya Perla | e7b909a | 2009-11-22 22:01:10 +0000 | [diff] [blame] | 1187 | return status; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1188 | } | 
|  | 1189 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1190 | /* Uses synchrounous mcc */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 1191 | int be_cmd_set_flow_control(struct be_adapter *adapter, u32 tx_fc, u32 rx_fc) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1192 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1193 | struct be_mcc_wrb *wrb; | 
|  | 1194 | struct be_cmd_req_set_flow_control *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1195 | int status; | 
|  | 1196 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1197 | spin_lock_bh(&adapter->mcc_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1198 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1199 | wrb = wrb_from_mccq(adapter); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1200 | if (!wrb) { | 
|  | 1201 | status = -EBUSY; | 
|  | 1202 | goto err; | 
|  | 1203 | } | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1204 | req = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1205 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 1206 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 1207 | OPCODE_COMMON_SET_FLOW_CONTROL); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1208 |  | 
|  | 1209 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 1210 | OPCODE_COMMON_SET_FLOW_CONTROL, sizeof(*req)); | 
|  | 1211 |  | 
|  | 1212 | req->tx_flow_control = cpu_to_le16((u16)tx_fc); | 
|  | 1213 | req->rx_flow_control = cpu_to_le16((u16)rx_fc); | 
|  | 1214 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1215 | status = be_mcc_notify_wait(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1216 |  | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1217 | err: | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1218 | spin_unlock_bh(&adapter->mcc_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1219 | return status; | 
|  | 1220 | } | 
|  | 1221 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1222 | /* Uses sycn mcc */ | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 1223 | int be_cmd_get_flow_control(struct be_adapter *adapter, u32 *tx_fc, u32 *rx_fc) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1224 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1225 | struct be_mcc_wrb *wrb; | 
|  | 1226 | struct be_cmd_req_get_flow_control *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1227 | int status; | 
|  | 1228 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1229 | spin_lock_bh(&adapter->mcc_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1230 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1231 | wrb = wrb_from_mccq(adapter); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1232 | if (!wrb) { | 
|  | 1233 | status = -EBUSY; | 
|  | 1234 | goto err; | 
|  | 1235 | } | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1236 | req = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1237 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 1238 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 1239 | OPCODE_COMMON_GET_FLOW_CONTROL); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1240 |  | 
|  | 1241 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 1242 | OPCODE_COMMON_GET_FLOW_CONTROL, sizeof(*req)); | 
|  | 1243 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1244 | status = be_mcc_notify_wait(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1245 | if (!status) { | 
|  | 1246 | struct be_cmd_resp_get_flow_control *resp = | 
|  | 1247 | embedded_payload(wrb); | 
|  | 1248 | *tx_fc = le16_to_cpu(resp->tx_flow_control); | 
|  | 1249 | *rx_fc = le16_to_cpu(resp->rx_flow_control); | 
|  | 1250 | } | 
|  | 1251 |  | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1252 | err: | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1253 | spin_unlock_bh(&adapter->mcc_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1254 | return status; | 
|  | 1255 | } | 
|  | 1256 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1257 | /* Uses mbox */ | 
| Ajit Khaparde | dcb9b56 | 2009-09-30 21:58:22 -0700 | [diff] [blame] | 1258 | int be_cmd_query_fw_cfg(struct be_adapter *adapter, u32 *port_num, u32 *cap) | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1259 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1260 | struct be_mcc_wrb *wrb; | 
|  | 1261 | struct be_cmd_req_query_fw_cfg *req; | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1262 | int status; | 
|  | 1263 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 1264 | spin_lock(&adapter->mbox_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1265 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1266 | wrb = wrb_from_mbox(adapter); | 
|  | 1267 | req = embedded_payload(wrb); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1268 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 1269 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 1270 | OPCODE_COMMON_QUERY_FIRMWARE_CONFIG); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1271 |  | 
|  | 1272 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 1273 | OPCODE_COMMON_QUERY_FIRMWARE_CONFIG, sizeof(*req)); | 
|  | 1274 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1275 | status = be_mbox_notify_wait(adapter); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1276 | if (!status) { | 
|  | 1277 | struct be_cmd_resp_query_fw_cfg *resp = embedded_payload(wrb); | 
|  | 1278 | *port_num = le32_to_cpu(resp->phys_port); | 
| Ajit Khaparde | dcb9b56 | 2009-09-30 21:58:22 -0700 | [diff] [blame] | 1279 | *cap = le32_to_cpu(resp->function_cap); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1280 | } | 
|  | 1281 |  | 
| Sathya Perla | 8788fdc | 2009-07-27 22:52:03 +0000 | [diff] [blame] | 1282 | spin_unlock(&adapter->mbox_lock); | 
| Sathya Perla | 6b7c5b9 | 2009-03-11 23:32:03 -0700 | [diff] [blame] | 1283 | return status; | 
|  | 1284 | } | 
| sarveshwarb | 14074ea | 2009-08-05 13:05:24 -0700 | [diff] [blame] | 1285 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1286 | /* Uses mbox */ | 
| sarveshwarb | 14074ea | 2009-08-05 13:05:24 -0700 | [diff] [blame] | 1287 | int be_cmd_reset_function(struct be_adapter *adapter) | 
|  | 1288 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1289 | struct be_mcc_wrb *wrb; | 
|  | 1290 | struct be_cmd_req_hdr *req; | 
| sarveshwarb | 14074ea | 2009-08-05 13:05:24 -0700 | [diff] [blame] | 1291 | int status; | 
|  | 1292 |  | 
|  | 1293 | spin_lock(&adapter->mbox_lock); | 
|  | 1294 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1295 | wrb = wrb_from_mbox(adapter); | 
|  | 1296 | req = embedded_payload(wrb); | 
| sarveshwarb | 14074ea | 2009-08-05 13:05:24 -0700 | [diff] [blame] | 1297 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 1298 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 1299 | OPCODE_COMMON_FUNCTION_RESET); | 
| sarveshwarb | 14074ea | 2009-08-05 13:05:24 -0700 | [diff] [blame] | 1300 |  | 
|  | 1301 | be_cmd_hdr_prepare(req, CMD_SUBSYSTEM_COMMON, | 
|  | 1302 | OPCODE_COMMON_FUNCTION_RESET, sizeof(*req)); | 
|  | 1303 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1304 | status = be_mbox_notify_wait(adapter); | 
| sarveshwarb | 14074ea | 2009-08-05 13:05:24 -0700 | [diff] [blame] | 1305 |  | 
|  | 1306 | spin_unlock(&adapter->mbox_lock); | 
|  | 1307 | return status; | 
|  | 1308 | } | 
| Ajit Khaparde | 8451748 | 2009-09-04 03:12:16 +0000 | [diff] [blame] | 1309 |  | 
| Sarveshwar Bandi | fad9ab2 | 2009-10-12 04:23:15 -0700 | [diff] [blame] | 1310 | /* Uses sync mcc */ | 
|  | 1311 | int be_cmd_set_beacon_state(struct be_adapter *adapter, u8 port_num, | 
|  | 1312 | u8 bcn, u8 sts, u8 state) | 
|  | 1313 | { | 
|  | 1314 | struct be_mcc_wrb *wrb; | 
|  | 1315 | struct be_cmd_req_enable_disable_beacon *req; | 
|  | 1316 | int status; | 
|  | 1317 |  | 
|  | 1318 | spin_lock_bh(&adapter->mcc_lock); | 
|  | 1319 |  | 
|  | 1320 | wrb = wrb_from_mccq(adapter); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1321 | if (!wrb) { | 
|  | 1322 | status = -EBUSY; | 
|  | 1323 | goto err; | 
|  | 1324 | } | 
| Sarveshwar Bandi | fad9ab2 | 2009-10-12 04:23:15 -0700 | [diff] [blame] | 1325 | req = embedded_payload(wrb); | 
|  | 1326 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 1327 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 1328 | OPCODE_COMMON_ENABLE_DISABLE_BEACON); | 
| Sarveshwar Bandi | fad9ab2 | 2009-10-12 04:23:15 -0700 | [diff] [blame] | 1329 |  | 
|  | 1330 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 1331 | OPCODE_COMMON_ENABLE_DISABLE_BEACON, sizeof(*req)); | 
|  | 1332 |  | 
|  | 1333 | req->port_num = port_num; | 
|  | 1334 | req->beacon_state = state; | 
|  | 1335 | req->beacon_duration = bcn; | 
|  | 1336 | req->status_duration = sts; | 
|  | 1337 |  | 
|  | 1338 | status = be_mcc_notify_wait(adapter); | 
|  | 1339 |  | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1340 | err: | 
| Sarveshwar Bandi | fad9ab2 | 2009-10-12 04:23:15 -0700 | [diff] [blame] | 1341 | spin_unlock_bh(&adapter->mcc_lock); | 
|  | 1342 | return status; | 
|  | 1343 | } | 
|  | 1344 |  | 
|  | 1345 | /* Uses sync mcc */ | 
|  | 1346 | int be_cmd_get_beacon_state(struct be_adapter *adapter, u8 port_num, u32 *state) | 
|  | 1347 | { | 
|  | 1348 | struct be_mcc_wrb *wrb; | 
|  | 1349 | struct be_cmd_req_get_beacon_state *req; | 
|  | 1350 | int status; | 
|  | 1351 |  | 
|  | 1352 | spin_lock_bh(&adapter->mcc_lock); | 
|  | 1353 |  | 
|  | 1354 | wrb = wrb_from_mccq(adapter); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1355 | if (!wrb) { | 
|  | 1356 | status = -EBUSY; | 
|  | 1357 | goto err; | 
|  | 1358 | } | 
| Sarveshwar Bandi | fad9ab2 | 2009-10-12 04:23:15 -0700 | [diff] [blame] | 1359 | req = embedded_payload(wrb); | 
|  | 1360 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 1361 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 1362 | OPCODE_COMMON_GET_BEACON_STATE); | 
| Sarveshwar Bandi | fad9ab2 | 2009-10-12 04:23:15 -0700 | [diff] [blame] | 1363 |  | 
|  | 1364 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 1365 | OPCODE_COMMON_GET_BEACON_STATE, sizeof(*req)); | 
|  | 1366 |  | 
|  | 1367 | req->port_num = port_num; | 
|  | 1368 |  | 
|  | 1369 | status = be_mcc_notify_wait(adapter); | 
|  | 1370 | if (!status) { | 
|  | 1371 | struct be_cmd_resp_get_beacon_state *resp = | 
|  | 1372 | embedded_payload(wrb); | 
|  | 1373 | *state = resp->beacon_state; | 
|  | 1374 | } | 
|  | 1375 |  | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1376 | err: | 
| Sarveshwar Bandi | fad9ab2 | 2009-10-12 04:23:15 -0700 | [diff] [blame] | 1377 | spin_unlock_bh(&adapter->mcc_lock); | 
|  | 1378 | return status; | 
|  | 1379 | } | 
|  | 1380 |  | 
| Sarveshwar Bandi | 0388f25 | 2009-10-28 04:15:20 -0700 | [diff] [blame] | 1381 | /* Uses sync mcc */ | 
|  | 1382 | int be_cmd_read_port_type(struct be_adapter *adapter, u32 port, | 
|  | 1383 | u8 *connector) | 
|  | 1384 | { | 
|  | 1385 | struct be_mcc_wrb *wrb; | 
|  | 1386 | struct be_cmd_req_port_type *req; | 
|  | 1387 | int status; | 
|  | 1388 |  | 
|  | 1389 | spin_lock_bh(&adapter->mcc_lock); | 
|  | 1390 |  | 
|  | 1391 | wrb = wrb_from_mccq(adapter); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1392 | if (!wrb) { | 
|  | 1393 | status = -EBUSY; | 
|  | 1394 | goto err; | 
|  | 1395 | } | 
| Sarveshwar Bandi | 0388f25 | 2009-10-28 04:15:20 -0700 | [diff] [blame] | 1396 | req = embedded_payload(wrb); | 
|  | 1397 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 1398 | be_wrb_hdr_prepare(wrb, sizeof(struct be_cmd_resp_port_type), true, 0, | 
|  | 1399 | OPCODE_COMMON_READ_TRANSRECV_DATA); | 
| Sarveshwar Bandi | 0388f25 | 2009-10-28 04:15:20 -0700 | [diff] [blame] | 1400 |  | 
|  | 1401 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 1402 | OPCODE_COMMON_READ_TRANSRECV_DATA, sizeof(*req)); | 
|  | 1403 |  | 
|  | 1404 | req->port = cpu_to_le32(port); | 
|  | 1405 | req->page_num = cpu_to_le32(TR_PAGE_A0); | 
|  | 1406 | status = be_mcc_notify_wait(adapter); | 
|  | 1407 | if (!status) { | 
|  | 1408 | struct be_cmd_resp_port_type *resp = embedded_payload(wrb); | 
|  | 1409 | *connector = resp->data.connector; | 
|  | 1410 | } | 
|  | 1411 |  | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1412 | err: | 
| Sarveshwar Bandi | 0388f25 | 2009-10-28 04:15:20 -0700 | [diff] [blame] | 1413 | spin_unlock_bh(&adapter->mcc_lock); | 
|  | 1414 | return status; | 
|  | 1415 | } | 
|  | 1416 |  | 
| Ajit Khaparde | 8451748 | 2009-09-04 03:12:16 +0000 | [diff] [blame] | 1417 | int be_cmd_write_flashrom(struct be_adapter *adapter, struct be_dma_mem *cmd, | 
|  | 1418 | u32 flash_type, u32 flash_opcode, u32 buf_size) | 
|  | 1419 | { | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1420 | struct be_mcc_wrb *wrb; | 
| Ajit Khaparde | 3f0d456 | 2010-02-09 01:30:35 +0000 | [diff] [blame] | 1421 | struct be_cmd_write_flashrom *req; | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1422 | struct be_sge *sge; | 
| Ajit Khaparde | 8451748 | 2009-09-04 03:12:16 +0000 | [diff] [blame] | 1423 | int status; | 
|  | 1424 |  | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1425 | spin_lock_bh(&adapter->mcc_lock); | 
| Sarveshwar Bandi | dd131e7 | 2010-05-25 16:16:32 -0700 | [diff] [blame] | 1426 | adapter->flash_status = 0; | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1427 |  | 
|  | 1428 | wrb = wrb_from_mccq(adapter); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1429 | if (!wrb) { | 
|  | 1430 | status = -EBUSY; | 
| Dan Carpenter | 2892d9c | 2010-05-26 04:46:35 +0000 | [diff] [blame] | 1431 | goto err_unlock; | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1432 | } | 
|  | 1433 | req = cmd->va; | 
| Sathya Perla | b31c50a | 2009-09-17 10:30:13 -0700 | [diff] [blame] | 1434 | sge = nonembedded_sgl(wrb); | 
|  | 1435 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 1436 | be_wrb_hdr_prepare(wrb, cmd->size, false, 1, | 
|  | 1437 | OPCODE_COMMON_WRITE_FLASHROM); | 
| Sarveshwar Bandi | dd131e7 | 2010-05-25 16:16:32 -0700 | [diff] [blame] | 1438 | wrb->tag1 = CMD_SUBSYSTEM_COMMON; | 
| Ajit Khaparde | 8451748 | 2009-09-04 03:12:16 +0000 | [diff] [blame] | 1439 |  | 
|  | 1440 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 1441 | OPCODE_COMMON_WRITE_FLASHROM, cmd->size); | 
|  | 1442 | sge->pa_hi = cpu_to_le32(upper_32_bits(cmd->dma)); | 
|  | 1443 | sge->pa_lo = cpu_to_le32(cmd->dma & 0xFFFFFFFF); | 
|  | 1444 | sge->len = cpu_to_le32(cmd->size); | 
|  | 1445 |  | 
|  | 1446 | req->params.op_type = cpu_to_le32(flash_type); | 
|  | 1447 | req->params.op_code = cpu_to_le32(flash_opcode); | 
|  | 1448 | req->params.data_buf_size = cpu_to_le32(buf_size); | 
|  | 1449 |  | 
| Sarveshwar Bandi | dd131e7 | 2010-05-25 16:16:32 -0700 | [diff] [blame] | 1450 | be_mcc_notify(adapter); | 
|  | 1451 | spin_unlock_bh(&adapter->mcc_lock); | 
|  | 1452 |  | 
|  | 1453 | if (!wait_for_completion_timeout(&adapter->flash_compl, | 
|  | 1454 | msecs_to_jiffies(12000))) | 
|  | 1455 | status = -1; | 
|  | 1456 | else | 
|  | 1457 | status = adapter->flash_status; | 
| Ajit Khaparde | 8451748 | 2009-09-04 03:12:16 +0000 | [diff] [blame] | 1458 |  | 
| Dan Carpenter | 2892d9c | 2010-05-26 04:46:35 +0000 | [diff] [blame] | 1459 | return status; | 
|  | 1460 |  | 
|  | 1461 | err_unlock: | 
|  | 1462 | spin_unlock_bh(&adapter->mcc_lock); | 
| Ajit Khaparde | 8451748 | 2009-09-04 03:12:16 +0000 | [diff] [blame] | 1463 | return status; | 
|  | 1464 | } | 
| Sarveshwar Bandi | fa9a6fe | 2009-11-20 14:23:47 -0800 | [diff] [blame] | 1465 |  | 
| Ajit Khaparde | 3f0d456 | 2010-02-09 01:30:35 +0000 | [diff] [blame] | 1466 | int be_cmd_get_flash_crc(struct be_adapter *adapter, u8 *flashed_crc, | 
|  | 1467 | int offset) | 
| Sarveshwar Bandi | fa9a6fe | 2009-11-20 14:23:47 -0800 | [diff] [blame] | 1468 | { | 
|  | 1469 | struct be_mcc_wrb *wrb; | 
|  | 1470 | struct be_cmd_write_flashrom *req; | 
|  | 1471 | int status; | 
|  | 1472 |  | 
|  | 1473 | spin_lock_bh(&adapter->mcc_lock); | 
|  | 1474 |  | 
|  | 1475 | wrb = wrb_from_mccq(adapter); | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1476 | if (!wrb) { | 
|  | 1477 | status = -EBUSY; | 
|  | 1478 | goto err; | 
|  | 1479 | } | 
| Sarveshwar Bandi | fa9a6fe | 2009-11-20 14:23:47 -0800 | [diff] [blame] | 1480 | req = embedded_payload(wrb); | 
|  | 1481 |  | 
| Ajit Khaparde | d744b44 | 2009-12-03 06:12:06 +0000 | [diff] [blame] | 1482 | be_wrb_hdr_prepare(wrb, sizeof(*req)+4, true, 0, | 
|  | 1483 | OPCODE_COMMON_READ_FLASHROM); | 
| Sarveshwar Bandi | fa9a6fe | 2009-11-20 14:23:47 -0800 | [diff] [blame] | 1484 |  | 
|  | 1485 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 1486 | OPCODE_COMMON_READ_FLASHROM, sizeof(*req)+4); | 
|  | 1487 |  | 
| Ajit Khaparde | 3f0d456 | 2010-02-09 01:30:35 +0000 | [diff] [blame] | 1488 | req->params.op_type = cpu_to_le32(IMG_TYPE_REDBOOT); | 
| Sarveshwar Bandi | fa9a6fe | 2009-11-20 14:23:47 -0800 | [diff] [blame] | 1489 | req->params.op_code = cpu_to_le32(FLASHROM_OPER_REPORT); | 
| Ajit Khaparde | 8b93b71 | 2010-03-31 01:57:10 +0000 | [diff] [blame] | 1490 | req->params.offset = cpu_to_le32(offset); | 
|  | 1491 | req->params.data_buf_size = cpu_to_le32(0x4); | 
| Sarveshwar Bandi | fa9a6fe | 2009-11-20 14:23:47 -0800 | [diff] [blame] | 1492 |  | 
|  | 1493 | status = be_mcc_notify_wait(adapter); | 
|  | 1494 | if (!status) | 
|  | 1495 | memcpy(flashed_crc, req->params.data_buf, 4); | 
|  | 1496 |  | 
| Sathya Perla | 713d0394 | 2009-11-22 22:02:45 +0000 | [diff] [blame] | 1497 | err: | 
| Sarveshwar Bandi | fa9a6fe | 2009-11-20 14:23:47 -0800 | [diff] [blame] | 1498 | spin_unlock_bh(&adapter->mcc_lock); | 
|  | 1499 | return status; | 
|  | 1500 | } | 
| Ajit Khaparde | 71d8d1b | 2009-12-03 06:16:59 +0000 | [diff] [blame] | 1501 |  | 
| Dan Carpenter | c196b02 | 2010-05-26 04:47:39 +0000 | [diff] [blame] | 1502 | int be_cmd_enable_magic_wol(struct be_adapter *adapter, u8 *mac, | 
| Ajit Khaparde | 71d8d1b | 2009-12-03 06:16:59 +0000 | [diff] [blame] | 1503 | struct be_dma_mem *nonemb_cmd) | 
|  | 1504 | { | 
|  | 1505 | struct be_mcc_wrb *wrb; | 
|  | 1506 | struct be_cmd_req_acpi_wol_magic_config *req; | 
|  | 1507 | struct be_sge *sge; | 
|  | 1508 | int status; | 
|  | 1509 |  | 
|  | 1510 | spin_lock_bh(&adapter->mcc_lock); | 
|  | 1511 |  | 
|  | 1512 | wrb = wrb_from_mccq(adapter); | 
|  | 1513 | if (!wrb) { | 
|  | 1514 | status = -EBUSY; | 
|  | 1515 | goto err; | 
|  | 1516 | } | 
|  | 1517 | req = nonemb_cmd->va; | 
|  | 1518 | sge = nonembedded_sgl(wrb); | 
|  | 1519 |  | 
|  | 1520 | be_wrb_hdr_prepare(wrb, sizeof(*req), false, 1, | 
|  | 1521 | OPCODE_ETH_ACPI_WOL_MAGIC_CONFIG); | 
|  | 1522 |  | 
|  | 1523 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_ETH, | 
|  | 1524 | OPCODE_ETH_ACPI_WOL_MAGIC_CONFIG, sizeof(*req)); | 
|  | 1525 | memcpy(req->magic_mac, mac, ETH_ALEN); | 
|  | 1526 |  | 
|  | 1527 | sge->pa_hi = cpu_to_le32(upper_32_bits(nonemb_cmd->dma)); | 
|  | 1528 | sge->pa_lo = cpu_to_le32(nonemb_cmd->dma & 0xFFFFFFFF); | 
|  | 1529 | sge->len = cpu_to_le32(nonemb_cmd->size); | 
|  | 1530 |  | 
|  | 1531 | status = be_mcc_notify_wait(adapter); | 
|  | 1532 |  | 
|  | 1533 | err: | 
|  | 1534 | spin_unlock_bh(&adapter->mcc_lock); | 
|  | 1535 | return status; | 
|  | 1536 | } | 
| Suresh R | ff33a6e | 2009-12-03 16:15:52 -0800 | [diff] [blame] | 1537 |  | 
| Sarveshwar Bandi | fced999 | 2009-12-23 04:41:44 +0000 | [diff] [blame] | 1538 | int be_cmd_set_loopback(struct be_adapter *adapter, u8 port_num, | 
|  | 1539 | u8 loopback_type, u8 enable) | 
|  | 1540 | { | 
|  | 1541 | struct be_mcc_wrb *wrb; | 
|  | 1542 | struct be_cmd_req_set_lmode *req; | 
|  | 1543 | int status; | 
|  | 1544 |  | 
|  | 1545 | spin_lock_bh(&adapter->mcc_lock); | 
|  | 1546 |  | 
|  | 1547 | wrb = wrb_from_mccq(adapter); | 
|  | 1548 | if (!wrb) { | 
|  | 1549 | status = -EBUSY; | 
|  | 1550 | goto err; | 
|  | 1551 | } | 
|  | 1552 |  | 
|  | 1553 | req = embedded_payload(wrb); | 
|  | 1554 |  | 
|  | 1555 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 1556 | OPCODE_LOWLEVEL_SET_LOOPBACK_MODE); | 
|  | 1557 |  | 
|  | 1558 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_LOWLEVEL, | 
|  | 1559 | OPCODE_LOWLEVEL_SET_LOOPBACK_MODE, | 
|  | 1560 | sizeof(*req)); | 
|  | 1561 |  | 
|  | 1562 | req->src_port = port_num; | 
|  | 1563 | req->dest_port = port_num; | 
|  | 1564 | req->loopback_type = loopback_type; | 
|  | 1565 | req->loopback_state = enable; | 
|  | 1566 |  | 
|  | 1567 | status = be_mcc_notify_wait(adapter); | 
|  | 1568 | err: | 
|  | 1569 | spin_unlock_bh(&adapter->mcc_lock); | 
|  | 1570 | return status; | 
|  | 1571 | } | 
|  | 1572 |  | 
| Suresh R | ff33a6e | 2009-12-03 16:15:52 -0800 | [diff] [blame] | 1573 | int be_cmd_loopback_test(struct be_adapter *adapter, u32 port_num, | 
|  | 1574 | u32 loopback_type, u32 pkt_size, u32 num_pkts, u64 pattern) | 
|  | 1575 | { | 
|  | 1576 | struct be_mcc_wrb *wrb; | 
|  | 1577 | struct be_cmd_req_loopback_test *req; | 
|  | 1578 | int status; | 
|  | 1579 |  | 
|  | 1580 | spin_lock_bh(&adapter->mcc_lock); | 
|  | 1581 |  | 
|  | 1582 | wrb = wrb_from_mccq(adapter); | 
|  | 1583 | if (!wrb) { | 
|  | 1584 | status = -EBUSY; | 
|  | 1585 | goto err; | 
|  | 1586 | } | 
|  | 1587 |  | 
|  | 1588 | req = embedded_payload(wrb); | 
|  | 1589 |  | 
|  | 1590 | be_wrb_hdr_prepare(wrb, sizeof(*req), true, 0, | 
|  | 1591 | OPCODE_LOWLEVEL_LOOPBACK_TEST); | 
|  | 1592 |  | 
|  | 1593 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_LOWLEVEL, | 
|  | 1594 | OPCODE_LOWLEVEL_LOOPBACK_TEST, sizeof(*req)); | 
| Sathya Perla | 3ffd051 | 2010-06-01 00:19:33 -0700 | [diff] [blame] | 1595 | req->hdr.timeout = cpu_to_le32(4); | 
| Suresh R | ff33a6e | 2009-12-03 16:15:52 -0800 | [diff] [blame] | 1596 |  | 
|  | 1597 | req->pattern = cpu_to_le64(pattern); | 
|  | 1598 | req->src_port = cpu_to_le32(port_num); | 
|  | 1599 | req->dest_port = cpu_to_le32(port_num); | 
|  | 1600 | req->pkt_size = cpu_to_le32(pkt_size); | 
|  | 1601 | req->num_pkts = cpu_to_le32(num_pkts); | 
|  | 1602 | req->loopback_type = cpu_to_le32(loopback_type); | 
|  | 1603 |  | 
|  | 1604 | status = be_mcc_notify_wait(adapter); | 
|  | 1605 | if (!status) { | 
|  | 1606 | struct be_cmd_resp_loopback_test *resp = embedded_payload(wrb); | 
|  | 1607 | status = le32_to_cpu(resp->status); | 
|  | 1608 | } | 
|  | 1609 |  | 
|  | 1610 | err: | 
|  | 1611 | spin_unlock_bh(&adapter->mcc_lock); | 
|  | 1612 | return status; | 
|  | 1613 | } | 
|  | 1614 |  | 
|  | 1615 | int be_cmd_ddr_dma_test(struct be_adapter *adapter, u64 pattern, | 
|  | 1616 | u32 byte_cnt, struct be_dma_mem *cmd) | 
|  | 1617 | { | 
|  | 1618 | struct be_mcc_wrb *wrb; | 
|  | 1619 | struct be_cmd_req_ddrdma_test *req; | 
|  | 1620 | struct be_sge *sge; | 
|  | 1621 | int status; | 
|  | 1622 | int i, j = 0; | 
|  | 1623 |  | 
|  | 1624 | spin_lock_bh(&adapter->mcc_lock); | 
|  | 1625 |  | 
|  | 1626 | wrb = wrb_from_mccq(adapter); | 
|  | 1627 | if (!wrb) { | 
|  | 1628 | status = -EBUSY; | 
|  | 1629 | goto err; | 
|  | 1630 | } | 
|  | 1631 | req = cmd->va; | 
|  | 1632 | sge = nonembedded_sgl(wrb); | 
|  | 1633 | be_wrb_hdr_prepare(wrb, cmd->size, false, 1, | 
|  | 1634 | OPCODE_LOWLEVEL_HOST_DDR_DMA); | 
|  | 1635 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_LOWLEVEL, | 
|  | 1636 | OPCODE_LOWLEVEL_HOST_DDR_DMA, cmd->size); | 
|  | 1637 |  | 
|  | 1638 | sge->pa_hi = cpu_to_le32(upper_32_bits(cmd->dma)); | 
|  | 1639 | sge->pa_lo = cpu_to_le32(cmd->dma & 0xFFFFFFFF); | 
|  | 1640 | sge->len = cpu_to_le32(cmd->size); | 
|  | 1641 |  | 
|  | 1642 | req->pattern = cpu_to_le64(pattern); | 
|  | 1643 | req->byte_count = cpu_to_le32(byte_cnt); | 
|  | 1644 | for (i = 0; i < byte_cnt; i++) { | 
|  | 1645 | req->snd_buff[i] = (u8)(pattern >> (j*8)); | 
|  | 1646 | j++; | 
|  | 1647 | if (j > 7) | 
|  | 1648 | j = 0; | 
|  | 1649 | } | 
|  | 1650 |  | 
|  | 1651 | status = be_mcc_notify_wait(adapter); | 
|  | 1652 |  | 
|  | 1653 | if (!status) { | 
|  | 1654 | struct be_cmd_resp_ddrdma_test *resp; | 
|  | 1655 | resp = cmd->va; | 
|  | 1656 | if ((memcmp(resp->rcv_buff, req->snd_buff, byte_cnt) != 0) || | 
|  | 1657 | resp->snd_err) { | 
|  | 1658 | status = -1; | 
|  | 1659 | } | 
|  | 1660 | } | 
|  | 1661 |  | 
|  | 1662 | err: | 
|  | 1663 | spin_unlock_bh(&adapter->mcc_lock); | 
|  | 1664 | return status; | 
|  | 1665 | } | 
| Sarveshwar Bandi | 368c0ca | 2010-01-08 00:07:27 -0800 | [diff] [blame] | 1666 |  | 
| Dan Carpenter | c196b02 | 2010-05-26 04:47:39 +0000 | [diff] [blame] | 1667 | int be_cmd_get_seeprom_data(struct be_adapter *adapter, | 
| Sarveshwar Bandi | 368c0ca | 2010-01-08 00:07:27 -0800 | [diff] [blame] | 1668 | struct be_dma_mem *nonemb_cmd) | 
|  | 1669 | { | 
|  | 1670 | struct be_mcc_wrb *wrb; | 
|  | 1671 | struct be_cmd_req_seeprom_read *req; | 
|  | 1672 | struct be_sge *sge; | 
|  | 1673 | int status; | 
|  | 1674 |  | 
|  | 1675 | spin_lock_bh(&adapter->mcc_lock); | 
|  | 1676 |  | 
|  | 1677 | wrb = wrb_from_mccq(adapter); | 
|  | 1678 | req = nonemb_cmd->va; | 
|  | 1679 | sge = nonembedded_sgl(wrb); | 
|  | 1680 |  | 
|  | 1681 | be_wrb_hdr_prepare(wrb, sizeof(*req), false, 1, | 
|  | 1682 | OPCODE_COMMON_SEEPROM_READ); | 
|  | 1683 |  | 
|  | 1684 | be_cmd_hdr_prepare(&req->hdr, CMD_SUBSYSTEM_COMMON, | 
|  | 1685 | OPCODE_COMMON_SEEPROM_READ, sizeof(*req)); | 
|  | 1686 |  | 
|  | 1687 | sge->pa_hi = cpu_to_le32(upper_32_bits(nonemb_cmd->dma)); | 
|  | 1688 | sge->pa_lo = cpu_to_le32(nonemb_cmd->dma & 0xFFFFFFFF); | 
|  | 1689 | sge->len = cpu_to_le32(nonemb_cmd->size); | 
|  | 1690 |  | 
|  | 1691 | status = be_mcc_notify_wait(adapter); | 
|  | 1692 |  | 
|  | 1693 | spin_unlock_bh(&adapter->mcc_lock); | 
|  | 1694 | return status; | 
|  | 1695 | } |