| Ramkrishna Vepa | 40a3a91 | 2009-04-01 18:14:40 +0000 | [diff] [blame] | 1 | /****************************************************************************** | 
|  | 2 | * This software may be used and distributed according to the terms of | 
|  | 3 | * the GNU General Public License (GPL), incorporated herein by reference. | 
|  | 4 | * Drivers based on or derived from this code fall under the GPL and must | 
|  | 5 | * retain the authorship, copyright and license notice.  This file is not | 
|  | 6 | * a complete program and may only be used when the entire operating | 
|  | 7 | * system is licensed under the GPL. | 
|  | 8 | * See the file COPYING in this distribution for more information. | 
|  | 9 | * | 
|  | 10 | * vxge-config.c: Driver for Neterion Inc's X3100 Series 10GbE PCIe I/O | 
|  | 11 | *                Virtualized Server Adapter. | 
|  | 12 | * Copyright(c) 2002-2009 Neterion Inc. | 
|  | 13 | ******************************************************************************/ | 
|  | 14 | #include <linux/vmalloc.h> | 
|  | 15 | #include <linux/etherdevice.h> | 
|  | 16 | #include <linux/pci.h> | 
|  | 17 | #include <linux/pci_hotplug.h> | 
|  | 18 |  | 
|  | 19 | #include "vxge-traffic.h" | 
|  | 20 | #include "vxge-config.h" | 
|  | 21 |  | 
|  | 22 | /* | 
|  | 23 | * __vxge_hw_channel_allocate - Allocate memory for channel | 
|  | 24 | * This function allocates required memory for the channel and various arrays | 
|  | 25 | * in the channel | 
|  | 26 | */ | 
|  | 27 | struct __vxge_hw_channel* | 
|  | 28 | __vxge_hw_channel_allocate(struct __vxge_hw_vpath_handle *vph, | 
|  | 29 | enum __vxge_hw_channel_type type, | 
|  | 30 | u32 length, u32 per_dtr_space, void *userdata) | 
|  | 31 | { | 
|  | 32 | struct __vxge_hw_channel *channel; | 
|  | 33 | struct __vxge_hw_device *hldev; | 
|  | 34 | int size = 0; | 
|  | 35 | u32 vp_id; | 
|  | 36 |  | 
|  | 37 | hldev = vph->vpath->hldev; | 
|  | 38 | vp_id = vph->vpath->vp_id; | 
|  | 39 |  | 
|  | 40 | switch (type) { | 
|  | 41 | case VXGE_HW_CHANNEL_TYPE_FIFO: | 
|  | 42 | size = sizeof(struct __vxge_hw_fifo); | 
|  | 43 | break; | 
|  | 44 | case VXGE_HW_CHANNEL_TYPE_RING: | 
|  | 45 | size = sizeof(struct __vxge_hw_ring); | 
|  | 46 | break; | 
|  | 47 | default: | 
|  | 48 | break; | 
|  | 49 | } | 
|  | 50 |  | 
|  | 51 | channel = kzalloc(size, GFP_KERNEL); | 
|  | 52 | if (channel == NULL) | 
|  | 53 | goto exit0; | 
|  | 54 | INIT_LIST_HEAD(&channel->item); | 
|  | 55 |  | 
|  | 56 | channel->common_reg = hldev->common_reg; | 
|  | 57 | channel->first_vp_id = hldev->first_vp_id; | 
|  | 58 | channel->type = type; | 
|  | 59 | channel->devh = hldev; | 
|  | 60 | channel->vph = vph; | 
|  | 61 | channel->userdata = userdata; | 
|  | 62 | channel->per_dtr_space = per_dtr_space; | 
|  | 63 | channel->length = length; | 
|  | 64 | channel->vp_id = vp_id; | 
|  | 65 |  | 
|  | 66 | channel->work_arr = kzalloc(sizeof(void *)*length, GFP_KERNEL); | 
|  | 67 | if (channel->work_arr == NULL) | 
|  | 68 | goto exit1; | 
|  | 69 |  | 
|  | 70 | channel->free_arr = kzalloc(sizeof(void *)*length, GFP_KERNEL); | 
|  | 71 | if (channel->free_arr == NULL) | 
|  | 72 | goto exit1; | 
|  | 73 | channel->free_ptr = length; | 
|  | 74 |  | 
|  | 75 | channel->reserve_arr = kzalloc(sizeof(void *)*length, GFP_KERNEL); | 
|  | 76 | if (channel->reserve_arr == NULL) | 
|  | 77 | goto exit1; | 
|  | 78 | channel->reserve_ptr = length; | 
|  | 79 | channel->reserve_top = 0; | 
|  | 80 |  | 
|  | 81 | channel->orig_arr = kzalloc(sizeof(void *)*length, GFP_KERNEL); | 
|  | 82 | if (channel->orig_arr == NULL) | 
|  | 83 | goto exit1; | 
|  | 84 |  | 
|  | 85 | return channel; | 
|  | 86 | exit1: | 
|  | 87 | __vxge_hw_channel_free(channel); | 
|  | 88 |  | 
|  | 89 | exit0: | 
|  | 90 | return NULL; | 
|  | 91 | } | 
|  | 92 |  | 
|  | 93 | /* | 
|  | 94 | * __vxge_hw_channel_free - Free memory allocated for channel | 
|  | 95 | * This function deallocates memory from the channel and various arrays | 
|  | 96 | * in the channel | 
|  | 97 | */ | 
|  | 98 | void __vxge_hw_channel_free(struct __vxge_hw_channel *channel) | 
|  | 99 | { | 
|  | 100 | kfree(channel->work_arr); | 
|  | 101 | kfree(channel->free_arr); | 
|  | 102 | kfree(channel->reserve_arr); | 
|  | 103 | kfree(channel->orig_arr); | 
|  | 104 | kfree(channel); | 
|  | 105 | } | 
|  | 106 |  | 
|  | 107 | /* | 
|  | 108 | * __vxge_hw_channel_initialize - Initialize a channel | 
|  | 109 | * This function initializes a channel by properly setting the | 
|  | 110 | * various references | 
|  | 111 | */ | 
|  | 112 | enum vxge_hw_status | 
|  | 113 | __vxge_hw_channel_initialize(struct __vxge_hw_channel *channel) | 
|  | 114 | { | 
|  | 115 | u32 i; | 
|  | 116 | struct __vxge_hw_virtualpath *vpath; | 
|  | 117 |  | 
|  | 118 | vpath = channel->vph->vpath; | 
|  | 119 |  | 
|  | 120 | if ((channel->reserve_arr != NULL) && (channel->orig_arr != NULL)) { | 
|  | 121 | for (i = 0; i < channel->length; i++) | 
|  | 122 | channel->orig_arr[i] = channel->reserve_arr[i]; | 
|  | 123 | } | 
|  | 124 |  | 
|  | 125 | switch (channel->type) { | 
|  | 126 | case VXGE_HW_CHANNEL_TYPE_FIFO: | 
|  | 127 | vpath->fifoh = (struct __vxge_hw_fifo *)channel; | 
|  | 128 | channel->stats = &((struct __vxge_hw_fifo *) | 
|  | 129 | channel)->stats->common_stats; | 
|  | 130 | break; | 
|  | 131 | case VXGE_HW_CHANNEL_TYPE_RING: | 
|  | 132 | vpath->ringh = (struct __vxge_hw_ring *)channel; | 
|  | 133 | channel->stats = &((struct __vxge_hw_ring *) | 
|  | 134 | channel)->stats->common_stats; | 
|  | 135 | break; | 
|  | 136 | default: | 
|  | 137 | break; | 
|  | 138 | } | 
|  | 139 |  | 
|  | 140 | return VXGE_HW_OK; | 
|  | 141 | } | 
|  | 142 |  | 
|  | 143 | /* | 
|  | 144 | * __vxge_hw_channel_reset - Resets a channel | 
|  | 145 | * This function resets a channel by properly setting the various references | 
|  | 146 | */ | 
|  | 147 | enum vxge_hw_status | 
|  | 148 | __vxge_hw_channel_reset(struct __vxge_hw_channel *channel) | 
|  | 149 | { | 
|  | 150 | u32 i; | 
|  | 151 |  | 
|  | 152 | for (i = 0; i < channel->length; i++) { | 
|  | 153 | if (channel->reserve_arr != NULL) | 
|  | 154 | channel->reserve_arr[i] = channel->orig_arr[i]; | 
|  | 155 | if (channel->free_arr != NULL) | 
|  | 156 | channel->free_arr[i] = NULL; | 
|  | 157 | if (channel->work_arr != NULL) | 
|  | 158 | channel->work_arr[i] = NULL; | 
|  | 159 | } | 
|  | 160 | channel->free_ptr = channel->length; | 
|  | 161 | channel->reserve_ptr = channel->length; | 
|  | 162 | channel->reserve_top = 0; | 
|  | 163 | channel->post_index = 0; | 
|  | 164 | channel->compl_index = 0; | 
|  | 165 |  | 
|  | 166 | return VXGE_HW_OK; | 
|  | 167 | } | 
|  | 168 |  | 
|  | 169 | /* | 
|  | 170 | * __vxge_hw_device_pci_e_init | 
|  | 171 | * Initialize certain PCI/PCI-X configuration registers | 
|  | 172 | * with recommended values. Save config space for future hw resets. | 
|  | 173 | */ | 
|  | 174 | void | 
|  | 175 | __vxge_hw_device_pci_e_init(struct __vxge_hw_device *hldev) | 
|  | 176 | { | 
|  | 177 | u16 cmd = 0; | 
|  | 178 |  | 
|  | 179 | /* Set the PErr Repconse bit and SERR in PCI command register. */ | 
|  | 180 | pci_read_config_word(hldev->pdev, PCI_COMMAND, &cmd); | 
|  | 181 | cmd |= 0x140; | 
|  | 182 | pci_write_config_word(hldev->pdev, PCI_COMMAND, cmd); | 
|  | 183 |  | 
|  | 184 | pci_save_state(hldev->pdev); | 
|  | 185 |  | 
|  | 186 | return; | 
|  | 187 | } | 
|  | 188 |  | 
|  | 189 | /* | 
|  | 190 | * __vxge_hw_device_register_poll | 
|  | 191 | * Will poll certain register for specified amount of time. | 
|  | 192 | * Will poll until masked bit is not cleared. | 
|  | 193 | */ | 
|  | 194 | enum vxge_hw_status | 
|  | 195 | __vxge_hw_device_register_poll(void __iomem *reg, u64 mask, u32 max_millis) | 
|  | 196 | { | 
|  | 197 | u64 val64; | 
|  | 198 | u32 i = 0; | 
|  | 199 | enum vxge_hw_status ret = VXGE_HW_FAIL; | 
|  | 200 |  | 
|  | 201 | udelay(10); | 
|  | 202 |  | 
|  | 203 | do { | 
|  | 204 | val64 = readq(reg); | 
|  | 205 | if (!(val64 & mask)) | 
|  | 206 | return VXGE_HW_OK; | 
|  | 207 | udelay(100); | 
|  | 208 | } while (++i <= 9); | 
|  | 209 |  | 
|  | 210 | i = 0; | 
|  | 211 | do { | 
|  | 212 | val64 = readq(reg); | 
|  | 213 | if (!(val64 & mask)) | 
|  | 214 | return VXGE_HW_OK; | 
|  | 215 | mdelay(1); | 
|  | 216 | } while (++i <= max_millis); | 
|  | 217 |  | 
|  | 218 | return ret; | 
|  | 219 | } | 
|  | 220 |  | 
|  | 221 | /* __vxge_hw_device_vpath_reset_in_prog_check - Check if vpath reset | 
|  | 222 | * in progress | 
|  | 223 | * This routine checks the vpath reset in progress register is turned zero | 
|  | 224 | */ | 
|  | 225 | enum vxge_hw_status | 
|  | 226 | __vxge_hw_device_vpath_reset_in_prog_check(u64 __iomem *vpath_rst_in_prog) | 
|  | 227 | { | 
|  | 228 | enum vxge_hw_status status; | 
|  | 229 | status = __vxge_hw_device_register_poll(vpath_rst_in_prog, | 
|  | 230 | VXGE_HW_VPATH_RST_IN_PROG_VPATH_RST_IN_PROG(0x1ffff), | 
|  | 231 | VXGE_HW_DEF_DEVICE_POLL_MILLIS); | 
|  | 232 | return status; | 
|  | 233 | } | 
|  | 234 |  | 
|  | 235 | /* | 
|  | 236 | * __vxge_hw_device_toc_get | 
|  | 237 | * This routine sets the swapper and reads the toc pointer and returns the | 
|  | 238 | * memory mapped address of the toc | 
|  | 239 | */ | 
|  | 240 | struct vxge_hw_toc_reg __iomem * | 
|  | 241 | __vxge_hw_device_toc_get(void __iomem *bar0) | 
|  | 242 | { | 
|  | 243 | u64 val64; | 
|  | 244 | struct vxge_hw_toc_reg __iomem *toc = NULL; | 
|  | 245 | enum vxge_hw_status status; | 
|  | 246 |  | 
|  | 247 | struct vxge_hw_legacy_reg __iomem *legacy_reg = | 
|  | 248 | (struct vxge_hw_legacy_reg __iomem *)bar0; | 
|  | 249 |  | 
|  | 250 | status = __vxge_hw_legacy_swapper_set(legacy_reg); | 
|  | 251 | if (status != VXGE_HW_OK) | 
|  | 252 | goto exit; | 
|  | 253 |  | 
|  | 254 | val64 =	readq(&legacy_reg->toc_first_pointer); | 
|  | 255 | toc = (struct vxge_hw_toc_reg __iomem *)(bar0+val64); | 
|  | 256 | exit: | 
|  | 257 | return toc; | 
|  | 258 | } | 
|  | 259 |  | 
|  | 260 | /* | 
|  | 261 | * __vxge_hw_device_reg_addr_get | 
|  | 262 | * This routine sets the swapper and reads the toc pointer and initializes the | 
|  | 263 | * register location pointers in the device object. It waits until the ric is | 
|  | 264 | * completed initializing registers. | 
|  | 265 | */ | 
|  | 266 | enum vxge_hw_status | 
|  | 267 | __vxge_hw_device_reg_addr_get(struct __vxge_hw_device *hldev) | 
|  | 268 | { | 
|  | 269 | u64 val64; | 
|  | 270 | u32 i; | 
|  | 271 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 272 |  | 
|  | 273 | hldev->legacy_reg = (struct vxge_hw_legacy_reg __iomem *)hldev->bar0; | 
|  | 274 |  | 
|  | 275 | hldev->toc_reg = __vxge_hw_device_toc_get(hldev->bar0); | 
|  | 276 | if (hldev->toc_reg  == NULL) { | 
|  | 277 | status = VXGE_HW_FAIL; | 
|  | 278 | goto exit; | 
|  | 279 | } | 
|  | 280 |  | 
|  | 281 | val64 = readq(&hldev->toc_reg->toc_common_pointer); | 
|  | 282 | hldev->common_reg = | 
|  | 283 | (struct vxge_hw_common_reg __iomem *)(hldev->bar0 + val64); | 
|  | 284 |  | 
|  | 285 | val64 = readq(&hldev->toc_reg->toc_mrpcim_pointer); | 
|  | 286 | hldev->mrpcim_reg = | 
|  | 287 | (struct vxge_hw_mrpcim_reg __iomem *)(hldev->bar0 + val64); | 
|  | 288 |  | 
|  | 289 | for (i = 0; i < VXGE_HW_TITAN_SRPCIM_REG_SPACES; i++) { | 
|  | 290 | val64 = readq(&hldev->toc_reg->toc_srpcim_pointer[i]); | 
|  | 291 | hldev->srpcim_reg[i] = | 
|  | 292 | (struct vxge_hw_srpcim_reg __iomem *) | 
|  | 293 | (hldev->bar0 + val64); | 
|  | 294 | } | 
|  | 295 |  | 
|  | 296 | for (i = 0; i < VXGE_HW_TITAN_VPMGMT_REG_SPACES; i++) { | 
|  | 297 | val64 = readq(&hldev->toc_reg->toc_vpmgmt_pointer[i]); | 
|  | 298 | hldev->vpmgmt_reg[i] = | 
|  | 299 | (struct vxge_hw_vpmgmt_reg __iomem *)(hldev->bar0 + val64); | 
|  | 300 | } | 
|  | 301 |  | 
|  | 302 | for (i = 0; i < VXGE_HW_TITAN_VPATH_REG_SPACES; i++) { | 
|  | 303 | val64 = readq(&hldev->toc_reg->toc_vpath_pointer[i]); | 
|  | 304 | hldev->vpath_reg[i] = | 
|  | 305 | (struct vxge_hw_vpath_reg __iomem *) | 
|  | 306 | (hldev->bar0 + val64); | 
|  | 307 | } | 
|  | 308 |  | 
|  | 309 | val64 = readq(&hldev->toc_reg->toc_kdfc); | 
|  | 310 |  | 
|  | 311 | switch (VXGE_HW_TOC_GET_KDFC_INITIAL_BIR(val64)) { | 
|  | 312 | case 0: | 
|  | 313 | hldev->kdfc = (u8 __iomem *)(hldev->bar0 + | 
|  | 314 | VXGE_HW_TOC_GET_KDFC_INITIAL_OFFSET(val64)); | 
|  | 315 | break; | 
|  | 316 | case 2: | 
|  | 317 | hldev->kdfc = (u8 __iomem *)(hldev->bar1 + | 
|  | 318 | VXGE_HW_TOC_GET_KDFC_INITIAL_OFFSET(val64)); | 
|  | 319 | break; | 
|  | 320 | case 4: | 
|  | 321 | hldev->kdfc = (u8 __iomem *)(hldev->bar2 + | 
|  | 322 | VXGE_HW_TOC_GET_KDFC_INITIAL_OFFSET(val64)); | 
|  | 323 | break; | 
|  | 324 | default: | 
|  | 325 | break; | 
|  | 326 | } | 
|  | 327 |  | 
|  | 328 | status = __vxge_hw_device_vpath_reset_in_prog_check( | 
|  | 329 | (u64 __iomem *)&hldev->common_reg->vpath_rst_in_prog); | 
|  | 330 | exit: | 
|  | 331 | return status; | 
|  | 332 | } | 
|  | 333 |  | 
|  | 334 | /* | 
|  | 335 | * __vxge_hw_device_id_get | 
|  | 336 | * This routine returns sets the device id and revision numbers into the device | 
|  | 337 | * structure | 
|  | 338 | */ | 
|  | 339 | void __vxge_hw_device_id_get(struct __vxge_hw_device *hldev) | 
|  | 340 | { | 
|  | 341 | u64 val64; | 
|  | 342 |  | 
|  | 343 | val64 = readq(&hldev->common_reg->titan_asic_id); | 
|  | 344 | hldev->device_id = | 
|  | 345 | (u16)VXGE_HW_TITAN_ASIC_ID_GET_INITIAL_DEVICE_ID(val64); | 
|  | 346 |  | 
|  | 347 | hldev->major_revision = | 
|  | 348 | (u8)VXGE_HW_TITAN_ASIC_ID_GET_INITIAL_MAJOR_REVISION(val64); | 
|  | 349 |  | 
|  | 350 | hldev->minor_revision = | 
|  | 351 | (u8)VXGE_HW_TITAN_ASIC_ID_GET_INITIAL_MINOR_REVISION(val64); | 
|  | 352 |  | 
|  | 353 | return; | 
|  | 354 | } | 
|  | 355 |  | 
|  | 356 | /* | 
|  | 357 | * __vxge_hw_device_access_rights_get: Get Access Rights of the driver | 
|  | 358 | * This routine returns the Access Rights of the driver | 
|  | 359 | */ | 
|  | 360 | static u32 | 
|  | 361 | __vxge_hw_device_access_rights_get(u32 host_type, u32 func_id) | 
|  | 362 | { | 
|  | 363 | u32 access_rights = VXGE_HW_DEVICE_ACCESS_RIGHT_VPATH; | 
|  | 364 |  | 
|  | 365 | switch (host_type) { | 
|  | 366 | case VXGE_HW_NO_MR_NO_SR_NORMAL_FUNCTION: | 
|  | 367 | if (func_id == 0) { | 
|  | 368 | access_rights |= VXGE_HW_DEVICE_ACCESS_RIGHT_MRPCIM | | 
|  | 369 | VXGE_HW_DEVICE_ACCESS_RIGHT_SRPCIM; | 
|  | 370 | } | 
|  | 371 | break; | 
|  | 372 | case VXGE_HW_MR_NO_SR_VH0_BASE_FUNCTION: | 
|  | 373 | access_rights |= VXGE_HW_DEVICE_ACCESS_RIGHT_MRPCIM | | 
|  | 374 | VXGE_HW_DEVICE_ACCESS_RIGHT_SRPCIM; | 
|  | 375 | break; | 
|  | 376 | case VXGE_HW_NO_MR_SR_VH0_FUNCTION0: | 
|  | 377 | access_rights |= VXGE_HW_DEVICE_ACCESS_RIGHT_MRPCIM | | 
|  | 378 | VXGE_HW_DEVICE_ACCESS_RIGHT_SRPCIM; | 
|  | 379 | break; | 
|  | 380 | case VXGE_HW_NO_MR_SR_VH0_VIRTUAL_FUNCTION: | 
|  | 381 | case VXGE_HW_SR_VH_VIRTUAL_FUNCTION: | 
|  | 382 | case VXGE_HW_MR_SR_VH0_INVALID_CONFIG: | 
|  | 383 | break; | 
|  | 384 | case VXGE_HW_SR_VH_FUNCTION0: | 
|  | 385 | case VXGE_HW_VH_NORMAL_FUNCTION: | 
|  | 386 | access_rights |= VXGE_HW_DEVICE_ACCESS_RIGHT_SRPCIM; | 
|  | 387 | break; | 
|  | 388 | } | 
|  | 389 |  | 
|  | 390 | return access_rights; | 
|  | 391 | } | 
|  | 392 | /* | 
|  | 393 | * __vxge_hw_device_host_info_get | 
|  | 394 | * This routine returns the host type assignments | 
|  | 395 | */ | 
|  | 396 | void __vxge_hw_device_host_info_get(struct __vxge_hw_device *hldev) | 
|  | 397 | { | 
|  | 398 | u64 val64; | 
|  | 399 | u32 i; | 
|  | 400 |  | 
|  | 401 | val64 = readq(&hldev->common_reg->host_type_assignments); | 
|  | 402 |  | 
|  | 403 | hldev->host_type = | 
|  | 404 | (u32)VXGE_HW_HOST_TYPE_ASSIGNMENTS_GET_HOST_TYPE_ASSIGNMENTS(val64); | 
|  | 405 |  | 
|  | 406 | hldev->vpath_assignments = readq(&hldev->common_reg->vpath_assignments); | 
|  | 407 |  | 
|  | 408 | for (i = 0; i < VXGE_HW_MAX_VIRTUAL_PATHS; i++) { | 
|  | 409 |  | 
|  | 410 | if (!(hldev->vpath_assignments & vxge_mBIT(i))) | 
|  | 411 | continue; | 
|  | 412 |  | 
|  | 413 | hldev->func_id = | 
|  | 414 | __vxge_hw_vpath_func_id_get(i, hldev->vpmgmt_reg[i]); | 
|  | 415 |  | 
|  | 416 | hldev->access_rights = __vxge_hw_device_access_rights_get( | 
|  | 417 | hldev->host_type, hldev->func_id); | 
|  | 418 |  | 
|  | 419 | hldev->first_vp_id = i; | 
|  | 420 | break; | 
|  | 421 | } | 
|  | 422 |  | 
|  | 423 | return; | 
|  | 424 | } | 
|  | 425 |  | 
|  | 426 | /* | 
|  | 427 | * __vxge_hw_verify_pci_e_info - Validate the pci-e link parameters such as | 
|  | 428 | * link width and signalling rate. | 
|  | 429 | */ | 
|  | 430 | static enum vxge_hw_status | 
|  | 431 | __vxge_hw_verify_pci_e_info(struct __vxge_hw_device *hldev) | 
|  | 432 | { | 
|  | 433 | int exp_cap; | 
|  | 434 | u16 lnk; | 
|  | 435 |  | 
|  | 436 | /* Get the negotiated link width and speed from PCI config space */ | 
|  | 437 | exp_cap = pci_find_capability(hldev->pdev, PCI_CAP_ID_EXP); | 
|  | 438 | pci_read_config_word(hldev->pdev, exp_cap + PCI_EXP_LNKSTA, &lnk); | 
|  | 439 |  | 
|  | 440 | if ((lnk & PCI_EXP_LNKSTA_CLS) != 1) | 
|  | 441 | return VXGE_HW_ERR_INVALID_PCI_INFO; | 
|  | 442 |  | 
|  | 443 | switch ((lnk & PCI_EXP_LNKSTA_NLW) >> 4) { | 
|  | 444 | case PCIE_LNK_WIDTH_RESRV: | 
|  | 445 | case PCIE_LNK_X1: | 
|  | 446 | case PCIE_LNK_X2: | 
|  | 447 | case PCIE_LNK_X4: | 
|  | 448 | case PCIE_LNK_X8: | 
|  | 449 | break; | 
|  | 450 | default: | 
|  | 451 | return VXGE_HW_ERR_INVALID_PCI_INFO; | 
|  | 452 | } | 
|  | 453 |  | 
|  | 454 | return VXGE_HW_OK; | 
|  | 455 | } | 
|  | 456 |  | 
|  | 457 | static enum vxge_hw_status | 
|  | 458 | __vxge_hw_device_is_privilaged(struct __vxge_hw_device *hldev) | 
|  | 459 | { | 
|  | 460 | if ((hldev->host_type == VXGE_HW_NO_MR_NO_SR_NORMAL_FUNCTION || | 
|  | 461 | hldev->host_type == VXGE_HW_MR_NO_SR_VH0_BASE_FUNCTION || | 
|  | 462 | hldev->host_type == VXGE_HW_NO_MR_SR_VH0_FUNCTION0) && | 
|  | 463 | (hldev->func_id == 0)) | 
|  | 464 | return VXGE_HW_OK; | 
|  | 465 | else | 
|  | 466 | return VXGE_HW_ERR_PRIVILAGED_OPEARATION; | 
|  | 467 | } | 
|  | 468 |  | 
|  | 469 | /* | 
|  | 470 | * vxge_hw_wrr_rebalance - Rebalance the RX_WRR and KDFC_WRR calandars. | 
|  | 471 | * Rebalance the RX_WRR and KDFC_WRR calandars. | 
|  | 472 | */ | 
|  | 473 | static enum | 
|  | 474 | vxge_hw_status vxge_hw_wrr_rebalance(struct __vxge_hw_device *hldev) | 
|  | 475 | { | 
|  | 476 | u64 val64; | 
|  | 477 | u32 wrr_states[VXGE_HW_WEIGHTED_RR_SERVICE_STATES]; | 
|  | 478 | u32 i, j, how_often = 1; | 
|  | 479 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 480 |  | 
|  | 481 | status = __vxge_hw_device_is_privilaged(hldev); | 
|  | 482 | if (status != VXGE_HW_OK) | 
|  | 483 | goto exit; | 
|  | 484 |  | 
|  | 485 | /* Reset the priorities assigned to the WRR arbitration | 
|  | 486 | phases for the receive traffic */ | 
|  | 487 | for (i = 0; i < VXGE_HW_WRR_RING_COUNT; i++) | 
|  | 488 | writeq(0, ((&hldev->mrpcim_reg->rx_w_round_robin_0) + i)); | 
|  | 489 |  | 
|  | 490 | /* Reset the transmit FIFO servicing calendar for FIFOs */ | 
|  | 491 | for (i = 0; i < VXGE_HW_WRR_FIFO_COUNT; i++) { | 
|  | 492 | writeq(0, ((&hldev->mrpcim_reg->kdfc_w_round_robin_0) + i)); | 
|  | 493 | writeq(0, ((&hldev->mrpcim_reg->kdfc_w_round_robin_20) + i)); | 
|  | 494 | } | 
|  | 495 |  | 
|  | 496 | /* Assign WRR priority  0 for all FIFOs */ | 
|  | 497 | for (i = 1; i < VXGE_HW_MAX_VIRTUAL_PATHS; i++) { | 
|  | 498 | writeq(VXGE_HW_KDFC_FIFO_0_CTRL_WRR_NUMBER(0), | 
|  | 499 | ((&hldev->mrpcim_reg->kdfc_fifo_0_ctrl)  + i)); | 
|  | 500 |  | 
|  | 501 | writeq(VXGE_HW_KDFC_FIFO_17_CTRL_WRR_NUMBER(0), | 
|  | 502 | ((&hldev->mrpcim_reg->kdfc_fifo_17_ctrl) + i)); | 
|  | 503 | } | 
|  | 504 |  | 
|  | 505 | /* Reset to service non-offload doorbells */ | 
|  | 506 | writeq(0, &hldev->mrpcim_reg->kdfc_entry_type_sel_0); | 
|  | 507 | writeq(0, &hldev->mrpcim_reg->kdfc_entry_type_sel_1); | 
|  | 508 |  | 
|  | 509 | /* Set priority 0 to all receive queues */ | 
|  | 510 | writeq(0, &hldev->mrpcim_reg->rx_queue_priority_0); | 
|  | 511 | writeq(0, &hldev->mrpcim_reg->rx_queue_priority_1); | 
|  | 512 | writeq(0, &hldev->mrpcim_reg->rx_queue_priority_2); | 
|  | 513 |  | 
|  | 514 | /* Initialize all the slots as unused */ | 
|  | 515 | for (i = 0; i < VXGE_HW_WEIGHTED_RR_SERVICE_STATES; i++) | 
|  | 516 | wrr_states[i] = -1; | 
|  | 517 |  | 
|  | 518 | /* Prepare the Fifo service states */ | 
|  | 519 | for (i = 0; i < VXGE_HW_MAX_VIRTUAL_PATHS; i++) { | 
|  | 520 |  | 
|  | 521 | if (!hldev->config.vp_config[i].min_bandwidth) | 
|  | 522 | continue; | 
|  | 523 |  | 
|  | 524 | how_often = VXGE_HW_VPATH_BANDWIDTH_MAX / | 
|  | 525 | hldev->config.vp_config[i].min_bandwidth; | 
|  | 526 | if (how_often) { | 
|  | 527 |  | 
|  | 528 | for (j = 0; j < VXGE_HW_WRR_FIFO_SERVICE_STATES;) { | 
|  | 529 | if (wrr_states[j] == -1) { | 
|  | 530 | wrr_states[j] = i; | 
|  | 531 | /* Make sure each fifo is serviced | 
|  | 532 | * atleast once */ | 
|  | 533 | if (i == j) | 
|  | 534 | j += VXGE_HW_MAX_VIRTUAL_PATHS; | 
|  | 535 | else | 
|  | 536 | j += how_often; | 
|  | 537 | } else | 
|  | 538 | j++; | 
|  | 539 | } | 
|  | 540 | } | 
|  | 541 | } | 
|  | 542 |  | 
|  | 543 | /* Fill the unused slots with 0 */ | 
|  | 544 | for (j = 0; j < VXGE_HW_WEIGHTED_RR_SERVICE_STATES; j++) { | 
|  | 545 | if (wrr_states[j] == -1) | 
|  | 546 | wrr_states[j] = 0; | 
|  | 547 | } | 
|  | 548 |  | 
|  | 549 | /* Assign WRR priority number for FIFOs */ | 
|  | 550 | for (i = 0; i < VXGE_HW_MAX_VIRTUAL_PATHS; i++) { | 
|  | 551 | writeq(VXGE_HW_KDFC_FIFO_0_CTRL_WRR_NUMBER(i), | 
|  | 552 | ((&hldev->mrpcim_reg->kdfc_fifo_0_ctrl) + i)); | 
|  | 553 |  | 
|  | 554 | writeq(VXGE_HW_KDFC_FIFO_17_CTRL_WRR_NUMBER(i), | 
|  | 555 | ((&hldev->mrpcim_reg->kdfc_fifo_17_ctrl) + i)); | 
|  | 556 | } | 
|  | 557 |  | 
|  | 558 | /* Modify the servicing algorithm applied to the 3 types of doorbells. | 
|  | 559 | i.e, none-offload, message and offload */ | 
|  | 560 | writeq(VXGE_HW_KDFC_ENTRY_TYPE_SEL_0_NUMBER_0(0) | | 
|  | 561 | VXGE_HW_KDFC_ENTRY_TYPE_SEL_0_NUMBER_1(0) | | 
|  | 562 | VXGE_HW_KDFC_ENTRY_TYPE_SEL_0_NUMBER_2(0) | | 
|  | 563 | VXGE_HW_KDFC_ENTRY_TYPE_SEL_0_NUMBER_3(0) | | 
|  | 564 | VXGE_HW_KDFC_ENTRY_TYPE_SEL_0_NUMBER_4(1) | | 
|  | 565 | VXGE_HW_KDFC_ENTRY_TYPE_SEL_0_NUMBER_5(0) | | 
|  | 566 | VXGE_HW_KDFC_ENTRY_TYPE_SEL_0_NUMBER_6(0) | | 
|  | 567 | VXGE_HW_KDFC_ENTRY_TYPE_SEL_0_NUMBER_7(0), | 
|  | 568 | &hldev->mrpcim_reg->kdfc_entry_type_sel_0); | 
|  | 569 |  | 
|  | 570 | writeq(VXGE_HW_KDFC_ENTRY_TYPE_SEL_1_NUMBER_8(1), | 
|  | 571 | &hldev->mrpcim_reg->kdfc_entry_type_sel_1); | 
|  | 572 |  | 
|  | 573 | for (i = 0, j = 0; i < VXGE_HW_WRR_FIFO_COUNT; i++) { | 
|  | 574 |  | 
|  | 575 | val64 = VXGE_HW_KDFC_W_ROUND_ROBIN_0_NUMBER_0(wrr_states[j++]); | 
|  | 576 | val64 |= VXGE_HW_KDFC_W_ROUND_ROBIN_0_NUMBER_1(wrr_states[j++]); | 
|  | 577 | val64 |= VXGE_HW_KDFC_W_ROUND_ROBIN_0_NUMBER_2(wrr_states[j++]); | 
|  | 578 | val64 |= VXGE_HW_KDFC_W_ROUND_ROBIN_0_NUMBER_3(wrr_states[j++]); | 
|  | 579 | val64 |= VXGE_HW_KDFC_W_ROUND_ROBIN_0_NUMBER_4(wrr_states[j++]); | 
|  | 580 | val64 |= VXGE_HW_KDFC_W_ROUND_ROBIN_0_NUMBER_5(wrr_states[j++]); | 
|  | 581 | val64 |= VXGE_HW_KDFC_W_ROUND_ROBIN_0_NUMBER_6(wrr_states[j++]); | 
|  | 582 | val64 |= VXGE_HW_KDFC_W_ROUND_ROBIN_0_NUMBER_7(wrr_states[j++]); | 
|  | 583 |  | 
|  | 584 | writeq(val64, (&hldev->mrpcim_reg->kdfc_w_round_robin_0 + i)); | 
|  | 585 | writeq(val64, (&hldev->mrpcim_reg->kdfc_w_round_robin_20 + i)); | 
|  | 586 | } | 
|  | 587 |  | 
|  | 588 | /* Set up the priorities assigned to receive queues */ | 
|  | 589 | writeq(VXGE_HW_RX_QUEUE_PRIORITY_0_RX_Q_NUMBER_0(0) | | 
|  | 590 | VXGE_HW_RX_QUEUE_PRIORITY_0_RX_Q_NUMBER_1(1) | | 
|  | 591 | VXGE_HW_RX_QUEUE_PRIORITY_0_RX_Q_NUMBER_2(2) | | 
|  | 592 | VXGE_HW_RX_QUEUE_PRIORITY_0_RX_Q_NUMBER_3(3) | | 
|  | 593 | VXGE_HW_RX_QUEUE_PRIORITY_0_RX_Q_NUMBER_4(4) | | 
|  | 594 | VXGE_HW_RX_QUEUE_PRIORITY_0_RX_Q_NUMBER_5(5) | | 
|  | 595 | VXGE_HW_RX_QUEUE_PRIORITY_0_RX_Q_NUMBER_6(6) | | 
|  | 596 | VXGE_HW_RX_QUEUE_PRIORITY_0_RX_Q_NUMBER_7(7), | 
|  | 597 | &hldev->mrpcim_reg->rx_queue_priority_0); | 
|  | 598 |  | 
|  | 599 | writeq(VXGE_HW_RX_QUEUE_PRIORITY_1_RX_Q_NUMBER_8(8) | | 
|  | 600 | VXGE_HW_RX_QUEUE_PRIORITY_1_RX_Q_NUMBER_9(9) | | 
|  | 601 | VXGE_HW_RX_QUEUE_PRIORITY_1_RX_Q_NUMBER_10(10) | | 
|  | 602 | VXGE_HW_RX_QUEUE_PRIORITY_1_RX_Q_NUMBER_11(11) | | 
|  | 603 | VXGE_HW_RX_QUEUE_PRIORITY_1_RX_Q_NUMBER_12(12) | | 
|  | 604 | VXGE_HW_RX_QUEUE_PRIORITY_1_RX_Q_NUMBER_13(13) | | 
|  | 605 | VXGE_HW_RX_QUEUE_PRIORITY_1_RX_Q_NUMBER_14(14) | | 
|  | 606 | VXGE_HW_RX_QUEUE_PRIORITY_1_RX_Q_NUMBER_15(15), | 
|  | 607 | &hldev->mrpcim_reg->rx_queue_priority_1); | 
|  | 608 |  | 
|  | 609 | writeq(VXGE_HW_RX_QUEUE_PRIORITY_2_RX_Q_NUMBER_16(16), | 
|  | 610 | &hldev->mrpcim_reg->rx_queue_priority_2); | 
|  | 611 |  | 
|  | 612 | /* Initialize all the slots as unused */ | 
|  | 613 | for (i = 0; i < VXGE_HW_WEIGHTED_RR_SERVICE_STATES; i++) | 
|  | 614 | wrr_states[i] = -1; | 
|  | 615 |  | 
|  | 616 | /* Prepare the Ring service states */ | 
|  | 617 | for (i = 0; i < VXGE_HW_MAX_VIRTUAL_PATHS; i++) { | 
|  | 618 |  | 
|  | 619 | if (!hldev->config.vp_config[i].min_bandwidth) | 
|  | 620 | continue; | 
|  | 621 |  | 
|  | 622 | how_often = VXGE_HW_VPATH_BANDWIDTH_MAX / | 
|  | 623 | hldev->config.vp_config[i].min_bandwidth; | 
|  | 624 |  | 
|  | 625 | if (how_often) { | 
|  | 626 | for (j = 0; j < VXGE_HW_WRR_RING_SERVICE_STATES;) { | 
|  | 627 | if (wrr_states[j] == -1) { | 
|  | 628 | wrr_states[j] = i; | 
|  | 629 | /* Make sure each ring is | 
|  | 630 | * serviced atleast once */ | 
|  | 631 | if (i == j) | 
|  | 632 | j += VXGE_HW_MAX_VIRTUAL_PATHS; | 
|  | 633 | else | 
|  | 634 | j += how_often; | 
|  | 635 | } else | 
|  | 636 | j++; | 
|  | 637 | } | 
|  | 638 | } | 
|  | 639 | } | 
|  | 640 |  | 
|  | 641 | /* Fill the unused slots with 0 */ | 
|  | 642 | for (j = 0; j < VXGE_HW_WEIGHTED_RR_SERVICE_STATES; j++) { | 
|  | 643 | if (wrr_states[j] == -1) | 
|  | 644 | wrr_states[j] = 0; | 
|  | 645 | } | 
|  | 646 |  | 
|  | 647 | for (i = 0, j = 0; i < VXGE_HW_WRR_RING_COUNT; i++) { | 
|  | 648 | val64 =  VXGE_HW_RX_W_ROUND_ROBIN_0_RX_W_PRIORITY_SS_0( | 
|  | 649 | wrr_states[j++]); | 
|  | 650 | val64 |=  VXGE_HW_RX_W_ROUND_ROBIN_0_RX_W_PRIORITY_SS_1( | 
|  | 651 | wrr_states[j++]); | 
|  | 652 | val64 |=  VXGE_HW_RX_W_ROUND_ROBIN_0_RX_W_PRIORITY_SS_2( | 
|  | 653 | wrr_states[j++]); | 
|  | 654 | val64 |=  VXGE_HW_RX_W_ROUND_ROBIN_0_RX_W_PRIORITY_SS_3( | 
|  | 655 | wrr_states[j++]); | 
|  | 656 | val64 |=  VXGE_HW_RX_W_ROUND_ROBIN_0_RX_W_PRIORITY_SS_4( | 
|  | 657 | wrr_states[j++]); | 
|  | 658 | val64 |=  VXGE_HW_RX_W_ROUND_ROBIN_0_RX_W_PRIORITY_SS_5( | 
|  | 659 | wrr_states[j++]); | 
|  | 660 | val64 |=  VXGE_HW_RX_W_ROUND_ROBIN_0_RX_W_PRIORITY_SS_6( | 
|  | 661 | wrr_states[j++]); | 
|  | 662 | val64 |=  VXGE_HW_RX_W_ROUND_ROBIN_0_RX_W_PRIORITY_SS_7( | 
|  | 663 | wrr_states[j++]); | 
|  | 664 |  | 
|  | 665 | writeq(val64, ((&hldev->mrpcim_reg->rx_w_round_robin_0) + i)); | 
|  | 666 | } | 
|  | 667 | exit: | 
|  | 668 | return status; | 
|  | 669 | } | 
|  | 670 |  | 
|  | 671 | /* | 
|  | 672 | * __vxge_hw_device_initialize | 
|  | 673 | * Initialize Titan-V hardware. | 
|  | 674 | */ | 
|  | 675 | enum vxge_hw_status __vxge_hw_device_initialize(struct __vxge_hw_device *hldev) | 
|  | 676 | { | 
|  | 677 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 678 |  | 
|  | 679 | /* Validate the pci-e link width and speed */ | 
|  | 680 | status = __vxge_hw_verify_pci_e_info(hldev); | 
|  | 681 | if (status != VXGE_HW_OK) | 
|  | 682 | goto exit; | 
|  | 683 |  | 
|  | 684 | vxge_hw_wrr_rebalance(hldev); | 
|  | 685 | exit: | 
|  | 686 | return status; | 
|  | 687 | } | 
|  | 688 |  | 
|  | 689 | /** | 
|  | 690 | * vxge_hw_device_hw_info_get - Get the hw information | 
|  | 691 | * Returns the vpath mask that has the bits set for each vpath allocated | 
|  | 692 | * for the driver, FW version information and the first mac addresse for | 
|  | 693 | * each vpath | 
|  | 694 | */ | 
|  | 695 | enum vxge_hw_status __devinit | 
|  | 696 | vxge_hw_device_hw_info_get(void __iomem *bar0, | 
|  | 697 | struct vxge_hw_device_hw_info *hw_info) | 
|  | 698 | { | 
|  | 699 | u32 i; | 
|  | 700 | u64 val64; | 
|  | 701 | struct vxge_hw_toc_reg __iomem *toc; | 
|  | 702 | struct vxge_hw_mrpcim_reg __iomem *mrpcim_reg; | 
|  | 703 | struct vxge_hw_common_reg __iomem *common_reg; | 
|  | 704 | struct vxge_hw_vpath_reg __iomem *vpath_reg; | 
|  | 705 | struct vxge_hw_vpmgmt_reg __iomem *vpmgmt_reg; | 
|  | 706 | enum vxge_hw_status status; | 
|  | 707 |  | 
|  | 708 | memset(hw_info, 0, sizeof(struct vxge_hw_device_hw_info)); | 
|  | 709 |  | 
|  | 710 | toc = __vxge_hw_device_toc_get(bar0); | 
|  | 711 | if (toc == NULL) { | 
|  | 712 | status = VXGE_HW_ERR_CRITICAL; | 
|  | 713 | goto exit; | 
|  | 714 | } | 
|  | 715 |  | 
|  | 716 | val64 = readq(&toc->toc_common_pointer); | 
|  | 717 | common_reg = (struct vxge_hw_common_reg __iomem *)(bar0 + val64); | 
|  | 718 |  | 
|  | 719 | status = __vxge_hw_device_vpath_reset_in_prog_check( | 
|  | 720 | (u64 __iomem *)&common_reg->vpath_rst_in_prog); | 
|  | 721 | if (status != VXGE_HW_OK) | 
|  | 722 | goto exit; | 
|  | 723 |  | 
|  | 724 | hw_info->vpath_mask = readq(&common_reg->vpath_assignments); | 
|  | 725 |  | 
|  | 726 | val64 = readq(&common_reg->host_type_assignments); | 
|  | 727 |  | 
|  | 728 | hw_info->host_type = | 
|  | 729 | (u32)VXGE_HW_HOST_TYPE_ASSIGNMENTS_GET_HOST_TYPE_ASSIGNMENTS(val64); | 
|  | 730 |  | 
|  | 731 | for (i = 0; i < VXGE_HW_MAX_VIRTUAL_PATHS; i++) { | 
|  | 732 |  | 
|  | 733 | if (!((hw_info->vpath_mask) & vxge_mBIT(i))) | 
|  | 734 | continue; | 
|  | 735 |  | 
|  | 736 | val64 = readq(&toc->toc_vpmgmt_pointer[i]); | 
|  | 737 |  | 
|  | 738 | vpmgmt_reg = (struct vxge_hw_vpmgmt_reg __iomem *) | 
|  | 739 | (bar0 + val64); | 
|  | 740 |  | 
|  | 741 | hw_info->func_id = __vxge_hw_vpath_func_id_get(i, vpmgmt_reg); | 
|  | 742 | if (__vxge_hw_device_access_rights_get(hw_info->host_type, | 
|  | 743 | hw_info->func_id) & | 
|  | 744 | VXGE_HW_DEVICE_ACCESS_RIGHT_MRPCIM) { | 
|  | 745 |  | 
|  | 746 | val64 = readq(&toc->toc_mrpcim_pointer); | 
|  | 747 |  | 
|  | 748 | mrpcim_reg = (struct vxge_hw_mrpcim_reg __iomem *) | 
|  | 749 | (bar0 + val64); | 
|  | 750 |  | 
|  | 751 | writeq(0, &mrpcim_reg->xgmac_gen_fw_memo_mask); | 
|  | 752 | wmb(); | 
|  | 753 | } | 
|  | 754 |  | 
|  | 755 | val64 = readq(&toc->toc_vpath_pointer[i]); | 
|  | 756 |  | 
|  | 757 | vpath_reg = (struct vxge_hw_vpath_reg __iomem *)(bar0 + val64); | 
|  | 758 |  | 
|  | 759 | hw_info->function_mode = | 
|  | 760 | __vxge_hw_vpath_pci_func_mode_get(i, vpath_reg); | 
|  | 761 |  | 
|  | 762 | status = __vxge_hw_vpath_fw_ver_get(i, vpath_reg, hw_info); | 
|  | 763 | if (status != VXGE_HW_OK) | 
|  | 764 | goto exit; | 
|  | 765 |  | 
|  | 766 | status = __vxge_hw_vpath_card_info_get(i, vpath_reg, hw_info); | 
|  | 767 | if (status != VXGE_HW_OK) | 
|  | 768 | goto exit; | 
|  | 769 |  | 
|  | 770 | break; | 
|  | 771 | } | 
|  | 772 |  | 
|  | 773 | for (i = 0; i < VXGE_HW_MAX_VIRTUAL_PATHS; i++) { | 
|  | 774 |  | 
|  | 775 | if (!((hw_info->vpath_mask) & vxge_mBIT(i))) | 
|  | 776 | continue; | 
|  | 777 |  | 
|  | 778 | val64 = readq(&toc->toc_vpath_pointer[i]); | 
|  | 779 | vpath_reg = (struct vxge_hw_vpath_reg __iomem *)(bar0 + val64); | 
|  | 780 |  | 
|  | 781 | status =  __vxge_hw_vpath_addr_get(i, vpath_reg, | 
|  | 782 | hw_info->mac_addrs[i], | 
|  | 783 | hw_info->mac_addr_masks[i]); | 
|  | 784 | if (status != VXGE_HW_OK) | 
|  | 785 | goto exit; | 
|  | 786 | } | 
|  | 787 | exit: | 
|  | 788 | return status; | 
|  | 789 | } | 
|  | 790 |  | 
|  | 791 | /* | 
|  | 792 | * vxge_hw_device_initialize - Initialize Titan device. | 
|  | 793 | * Initialize Titan device. Note that all the arguments of this public API | 
|  | 794 | * are 'IN', including @hldev. Driver cooperates with | 
|  | 795 | * OS to find new Titan device, locate its PCI and memory spaces. | 
|  | 796 | * | 
|  | 797 | * When done, the driver allocates sizeof(struct __vxge_hw_device) bytes for HW | 
|  | 798 | * to enable the latter to perform Titan hardware initialization. | 
|  | 799 | */ | 
|  | 800 | enum vxge_hw_status __devinit | 
|  | 801 | vxge_hw_device_initialize( | 
|  | 802 | struct __vxge_hw_device **devh, | 
|  | 803 | struct vxge_hw_device_attr *attr, | 
|  | 804 | struct vxge_hw_device_config *device_config) | 
|  | 805 | { | 
|  | 806 | u32 i; | 
|  | 807 | u32 nblocks = 0; | 
|  | 808 | struct __vxge_hw_device *hldev = NULL; | 
|  | 809 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 810 |  | 
|  | 811 | status = __vxge_hw_device_config_check(device_config); | 
|  | 812 | if (status != VXGE_HW_OK) | 
|  | 813 | goto exit; | 
|  | 814 |  | 
|  | 815 | hldev = (struct __vxge_hw_device *) | 
|  | 816 | vmalloc(sizeof(struct __vxge_hw_device)); | 
|  | 817 | if (hldev == NULL) { | 
|  | 818 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 819 | goto exit; | 
|  | 820 | } | 
|  | 821 |  | 
|  | 822 | memset(hldev, 0, sizeof(struct __vxge_hw_device)); | 
|  | 823 | hldev->magic = VXGE_HW_DEVICE_MAGIC; | 
|  | 824 |  | 
|  | 825 | vxge_hw_device_debug_set(hldev, VXGE_ERR, VXGE_COMPONENT_ALL); | 
|  | 826 |  | 
|  | 827 | /* apply config */ | 
|  | 828 | memcpy(&hldev->config, device_config, | 
|  | 829 | sizeof(struct vxge_hw_device_config)); | 
|  | 830 |  | 
|  | 831 | hldev->bar0 = attr->bar0; | 
|  | 832 | hldev->bar1 = attr->bar1; | 
|  | 833 | hldev->bar2 = attr->bar2; | 
|  | 834 | hldev->pdev = attr->pdev; | 
|  | 835 |  | 
|  | 836 | hldev->uld_callbacks.link_up = attr->uld_callbacks.link_up; | 
|  | 837 | hldev->uld_callbacks.link_down = attr->uld_callbacks.link_down; | 
|  | 838 | hldev->uld_callbacks.crit_err = attr->uld_callbacks.crit_err; | 
|  | 839 |  | 
|  | 840 | __vxge_hw_device_pci_e_init(hldev); | 
|  | 841 |  | 
|  | 842 | status = __vxge_hw_device_reg_addr_get(hldev); | 
|  | 843 | if (status != VXGE_HW_OK) | 
|  | 844 | goto exit; | 
|  | 845 | __vxge_hw_device_id_get(hldev); | 
|  | 846 |  | 
|  | 847 | __vxge_hw_device_host_info_get(hldev); | 
|  | 848 |  | 
|  | 849 | /* Incrementing for stats blocks */ | 
|  | 850 | nblocks++; | 
|  | 851 |  | 
|  | 852 | for (i = 0; i < VXGE_HW_MAX_VIRTUAL_PATHS; i++) { | 
|  | 853 |  | 
|  | 854 | if (!(hldev->vpath_assignments & vxge_mBIT(i))) | 
|  | 855 | continue; | 
|  | 856 |  | 
|  | 857 | if (device_config->vp_config[i].ring.enable == | 
|  | 858 | VXGE_HW_RING_ENABLE) | 
|  | 859 | nblocks += device_config->vp_config[i].ring.ring_blocks; | 
|  | 860 |  | 
|  | 861 | if (device_config->vp_config[i].fifo.enable == | 
|  | 862 | VXGE_HW_FIFO_ENABLE) | 
|  | 863 | nblocks += device_config->vp_config[i].fifo.fifo_blocks; | 
|  | 864 | nblocks++; | 
|  | 865 | } | 
|  | 866 |  | 
|  | 867 | if (__vxge_hw_blockpool_create(hldev, | 
|  | 868 | &hldev->block_pool, | 
|  | 869 | device_config->dma_blockpool_initial + nblocks, | 
|  | 870 | device_config->dma_blockpool_max + nblocks) != VXGE_HW_OK) { | 
|  | 871 |  | 
|  | 872 | vxge_hw_device_terminate(hldev); | 
|  | 873 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 874 | goto exit; | 
|  | 875 | } | 
|  | 876 |  | 
|  | 877 | status = __vxge_hw_device_initialize(hldev); | 
|  | 878 |  | 
|  | 879 | if (status != VXGE_HW_OK) { | 
|  | 880 | vxge_hw_device_terminate(hldev); | 
|  | 881 | goto exit; | 
|  | 882 | } | 
|  | 883 |  | 
|  | 884 | *devh = hldev; | 
|  | 885 | exit: | 
|  | 886 | return status; | 
|  | 887 | } | 
|  | 888 |  | 
|  | 889 | /* | 
|  | 890 | * vxge_hw_device_terminate - Terminate Titan device. | 
|  | 891 | * Terminate HW device. | 
|  | 892 | */ | 
|  | 893 | void | 
|  | 894 | vxge_hw_device_terminate(struct __vxge_hw_device *hldev) | 
|  | 895 | { | 
|  | 896 | vxge_assert(hldev->magic == VXGE_HW_DEVICE_MAGIC); | 
|  | 897 |  | 
|  | 898 | hldev->magic = VXGE_HW_DEVICE_DEAD; | 
|  | 899 | __vxge_hw_blockpool_destroy(&hldev->block_pool); | 
|  | 900 | vfree(hldev); | 
|  | 901 | } | 
|  | 902 |  | 
|  | 903 | /* | 
|  | 904 | * vxge_hw_device_stats_get - Get the device hw statistics. | 
|  | 905 | * Returns the vpath h/w stats for the device. | 
|  | 906 | */ | 
|  | 907 | enum vxge_hw_status | 
|  | 908 | vxge_hw_device_stats_get(struct __vxge_hw_device *hldev, | 
|  | 909 | struct vxge_hw_device_stats_hw_info *hw_stats) | 
|  | 910 | { | 
|  | 911 | u32 i; | 
|  | 912 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 913 |  | 
|  | 914 | for (i = 0; i < VXGE_HW_MAX_VIRTUAL_PATHS; i++) { | 
|  | 915 |  | 
|  | 916 | if (!(hldev->vpaths_deployed & vxge_mBIT(i)) || | 
|  | 917 | (hldev->virtual_paths[i].vp_open == | 
|  | 918 | VXGE_HW_VP_NOT_OPEN)) | 
|  | 919 | continue; | 
|  | 920 |  | 
|  | 921 | memcpy(hldev->virtual_paths[i].hw_stats_sav, | 
|  | 922 | hldev->virtual_paths[i].hw_stats, | 
|  | 923 | sizeof(struct vxge_hw_vpath_stats_hw_info)); | 
|  | 924 |  | 
|  | 925 | status = __vxge_hw_vpath_stats_get( | 
|  | 926 | &hldev->virtual_paths[i], | 
|  | 927 | hldev->virtual_paths[i].hw_stats); | 
|  | 928 | } | 
|  | 929 |  | 
|  | 930 | memcpy(hw_stats, &hldev->stats.hw_dev_info_stats, | 
|  | 931 | sizeof(struct vxge_hw_device_stats_hw_info)); | 
|  | 932 |  | 
|  | 933 | return status; | 
|  | 934 | } | 
|  | 935 |  | 
|  | 936 | /* | 
|  | 937 | * vxge_hw_driver_stats_get - Get the device sw statistics. | 
|  | 938 | * Returns the vpath s/w stats for the device. | 
|  | 939 | */ | 
|  | 940 | enum vxge_hw_status vxge_hw_driver_stats_get( | 
|  | 941 | struct __vxge_hw_device *hldev, | 
|  | 942 | struct vxge_hw_device_stats_sw_info *sw_stats) | 
|  | 943 | { | 
|  | 944 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 945 |  | 
|  | 946 | memcpy(sw_stats, &hldev->stats.sw_dev_info_stats, | 
|  | 947 | sizeof(struct vxge_hw_device_stats_sw_info)); | 
|  | 948 |  | 
|  | 949 | return status; | 
|  | 950 | } | 
|  | 951 |  | 
|  | 952 | /* | 
|  | 953 | * vxge_hw_mrpcim_stats_access - Access the statistics from the given location | 
|  | 954 | *                           and offset and perform an operation | 
|  | 955 | * Get the statistics from the given location and offset. | 
|  | 956 | */ | 
|  | 957 | enum vxge_hw_status | 
|  | 958 | vxge_hw_mrpcim_stats_access(struct __vxge_hw_device *hldev, | 
|  | 959 | u32 operation, u32 location, u32 offset, u64 *stat) | 
|  | 960 | { | 
|  | 961 | u64 val64; | 
|  | 962 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 963 |  | 
|  | 964 | status = __vxge_hw_device_is_privilaged(hldev); | 
|  | 965 | if (status != VXGE_HW_OK) | 
|  | 966 | goto exit; | 
|  | 967 |  | 
|  | 968 | val64 = VXGE_HW_XMAC_STATS_SYS_CMD_OP(operation) | | 
|  | 969 | VXGE_HW_XMAC_STATS_SYS_CMD_STROBE | | 
|  | 970 | VXGE_HW_XMAC_STATS_SYS_CMD_LOC_SEL(location) | | 
|  | 971 | VXGE_HW_XMAC_STATS_SYS_CMD_OFFSET_SEL(offset); | 
|  | 972 |  | 
|  | 973 | status = __vxge_hw_pio_mem_write64(val64, | 
|  | 974 | &hldev->mrpcim_reg->xmac_stats_sys_cmd, | 
|  | 975 | VXGE_HW_XMAC_STATS_SYS_CMD_STROBE, | 
|  | 976 | hldev->config.device_poll_millis); | 
|  | 977 |  | 
|  | 978 | if ((status == VXGE_HW_OK) && (operation == VXGE_HW_STATS_OP_READ)) | 
|  | 979 | *stat = readq(&hldev->mrpcim_reg->xmac_stats_sys_data); | 
|  | 980 | else | 
|  | 981 | *stat = 0; | 
|  | 982 | exit: | 
|  | 983 | return status; | 
|  | 984 | } | 
|  | 985 |  | 
|  | 986 | /* | 
|  | 987 | * vxge_hw_device_xmac_aggr_stats_get - Get the Statistics on aggregate port | 
|  | 988 | * Get the Statistics on aggregate port | 
|  | 989 | */ | 
|  | 990 | enum vxge_hw_status | 
|  | 991 | vxge_hw_device_xmac_aggr_stats_get(struct __vxge_hw_device *hldev, u32 port, | 
|  | 992 | struct vxge_hw_xmac_aggr_stats *aggr_stats) | 
|  | 993 | { | 
|  | 994 | u64 *val64; | 
|  | 995 | int i; | 
|  | 996 | u32 offset = VXGE_HW_STATS_AGGRn_OFFSET; | 
|  | 997 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 998 |  | 
|  | 999 | val64 = (u64 *)aggr_stats; | 
|  | 1000 |  | 
|  | 1001 | status = __vxge_hw_device_is_privilaged(hldev); | 
|  | 1002 | if (status != VXGE_HW_OK) | 
|  | 1003 | goto exit; | 
|  | 1004 |  | 
|  | 1005 | for (i = 0; i < sizeof(struct vxge_hw_xmac_aggr_stats) / 8; i++) { | 
|  | 1006 | status = vxge_hw_mrpcim_stats_access(hldev, | 
|  | 1007 | VXGE_HW_STATS_OP_READ, | 
|  | 1008 | VXGE_HW_STATS_LOC_AGGR, | 
|  | 1009 | ((offset + (104 * port)) >> 3), val64); | 
|  | 1010 | if (status != VXGE_HW_OK) | 
|  | 1011 | goto exit; | 
|  | 1012 |  | 
|  | 1013 | offset += 8; | 
|  | 1014 | val64++; | 
|  | 1015 | } | 
|  | 1016 | exit: | 
|  | 1017 | return status; | 
|  | 1018 | } | 
|  | 1019 |  | 
|  | 1020 | /* | 
|  | 1021 | * vxge_hw_device_xmac_port_stats_get - Get the Statistics on a port | 
|  | 1022 | * Get the Statistics on port | 
|  | 1023 | */ | 
|  | 1024 | enum vxge_hw_status | 
|  | 1025 | vxge_hw_device_xmac_port_stats_get(struct __vxge_hw_device *hldev, u32 port, | 
|  | 1026 | struct vxge_hw_xmac_port_stats *port_stats) | 
|  | 1027 | { | 
|  | 1028 | u64 *val64; | 
|  | 1029 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 1030 | int i; | 
|  | 1031 | u32 offset = 0x0; | 
|  | 1032 | val64 = (u64 *) port_stats; | 
|  | 1033 |  | 
|  | 1034 | status = __vxge_hw_device_is_privilaged(hldev); | 
|  | 1035 | if (status != VXGE_HW_OK) | 
|  | 1036 | goto exit; | 
|  | 1037 |  | 
|  | 1038 | for (i = 0; i < sizeof(struct vxge_hw_xmac_port_stats) / 8; i++) { | 
|  | 1039 | status = vxge_hw_mrpcim_stats_access(hldev, | 
|  | 1040 | VXGE_HW_STATS_OP_READ, | 
|  | 1041 | VXGE_HW_STATS_LOC_AGGR, | 
|  | 1042 | ((offset + (608 * port)) >> 3), val64); | 
|  | 1043 | if (status != VXGE_HW_OK) | 
|  | 1044 | goto exit; | 
|  | 1045 |  | 
|  | 1046 | offset += 8; | 
|  | 1047 | val64++; | 
|  | 1048 | } | 
|  | 1049 |  | 
|  | 1050 | exit: | 
|  | 1051 | return status; | 
|  | 1052 | } | 
|  | 1053 |  | 
|  | 1054 | /* | 
|  | 1055 | * vxge_hw_device_xmac_stats_get - Get the XMAC Statistics | 
|  | 1056 | * Get the XMAC Statistics | 
|  | 1057 | */ | 
|  | 1058 | enum vxge_hw_status | 
|  | 1059 | vxge_hw_device_xmac_stats_get(struct __vxge_hw_device *hldev, | 
|  | 1060 | struct vxge_hw_xmac_stats *xmac_stats) | 
|  | 1061 | { | 
|  | 1062 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 1063 | u32 i; | 
|  | 1064 |  | 
|  | 1065 | status = vxge_hw_device_xmac_aggr_stats_get(hldev, | 
|  | 1066 | 0, &xmac_stats->aggr_stats[0]); | 
|  | 1067 |  | 
|  | 1068 | if (status != VXGE_HW_OK) | 
|  | 1069 | goto exit; | 
|  | 1070 |  | 
|  | 1071 | status = vxge_hw_device_xmac_aggr_stats_get(hldev, | 
|  | 1072 | 1, &xmac_stats->aggr_stats[1]); | 
|  | 1073 | if (status != VXGE_HW_OK) | 
|  | 1074 | goto exit; | 
|  | 1075 |  | 
|  | 1076 | for (i = 0; i <= VXGE_HW_MAC_MAX_MAC_PORT_ID; i++) { | 
|  | 1077 |  | 
|  | 1078 | status = vxge_hw_device_xmac_port_stats_get(hldev, | 
|  | 1079 | i, &xmac_stats->port_stats[i]); | 
|  | 1080 | if (status != VXGE_HW_OK) | 
|  | 1081 | goto exit; | 
|  | 1082 | } | 
|  | 1083 |  | 
|  | 1084 | for (i = 0; i < VXGE_HW_MAX_VIRTUAL_PATHS; i++) { | 
|  | 1085 |  | 
|  | 1086 | if (!(hldev->vpaths_deployed & vxge_mBIT(i))) | 
|  | 1087 | continue; | 
|  | 1088 |  | 
|  | 1089 | status = __vxge_hw_vpath_xmac_tx_stats_get( | 
|  | 1090 | &hldev->virtual_paths[i], | 
|  | 1091 | &xmac_stats->vpath_tx_stats[i]); | 
|  | 1092 | if (status != VXGE_HW_OK) | 
|  | 1093 | goto exit; | 
|  | 1094 |  | 
|  | 1095 | status = __vxge_hw_vpath_xmac_rx_stats_get( | 
|  | 1096 | &hldev->virtual_paths[i], | 
|  | 1097 | &xmac_stats->vpath_rx_stats[i]); | 
|  | 1098 | if (status != VXGE_HW_OK) | 
|  | 1099 | goto exit; | 
|  | 1100 | } | 
|  | 1101 | exit: | 
|  | 1102 | return status; | 
|  | 1103 | } | 
|  | 1104 |  | 
|  | 1105 | /* | 
|  | 1106 | * vxge_hw_device_debug_set - Set the debug module, level and timestamp | 
|  | 1107 | * This routine is used to dynamically change the debug output | 
|  | 1108 | */ | 
|  | 1109 | void vxge_hw_device_debug_set(struct __vxge_hw_device *hldev, | 
|  | 1110 | enum vxge_debug_level level, u32 mask) | 
|  | 1111 | { | 
|  | 1112 | if (hldev == NULL) | 
|  | 1113 | return; | 
|  | 1114 |  | 
|  | 1115 | #if defined(VXGE_DEBUG_TRACE_MASK) || \ | 
|  | 1116 | defined(VXGE_DEBUG_ERR_MASK) | 
|  | 1117 | hldev->debug_module_mask = mask; | 
|  | 1118 | hldev->debug_level = level; | 
|  | 1119 | #endif | 
|  | 1120 |  | 
|  | 1121 | #if defined(VXGE_DEBUG_ERR_MASK) | 
|  | 1122 | hldev->level_err = level & VXGE_ERR; | 
|  | 1123 | #endif | 
|  | 1124 |  | 
|  | 1125 | #if defined(VXGE_DEBUG_TRACE_MASK) | 
|  | 1126 | hldev->level_trace = level & VXGE_TRACE; | 
|  | 1127 | #endif | 
|  | 1128 | } | 
|  | 1129 |  | 
|  | 1130 | /* | 
|  | 1131 | * vxge_hw_device_error_level_get - Get the error level | 
|  | 1132 | * This routine returns the current error level set | 
|  | 1133 | */ | 
|  | 1134 | u32 vxge_hw_device_error_level_get(struct __vxge_hw_device *hldev) | 
|  | 1135 | { | 
|  | 1136 | #if defined(VXGE_DEBUG_ERR_MASK) | 
|  | 1137 | if (hldev == NULL) | 
|  | 1138 | return VXGE_ERR; | 
|  | 1139 | else | 
|  | 1140 | return hldev->level_err; | 
|  | 1141 | #else | 
|  | 1142 | return 0; | 
|  | 1143 | #endif | 
|  | 1144 | } | 
|  | 1145 |  | 
|  | 1146 | /* | 
|  | 1147 | * vxge_hw_device_trace_level_get - Get the trace level | 
|  | 1148 | * This routine returns the current trace level set | 
|  | 1149 | */ | 
|  | 1150 | u32 vxge_hw_device_trace_level_get(struct __vxge_hw_device *hldev) | 
|  | 1151 | { | 
|  | 1152 | #if defined(VXGE_DEBUG_TRACE_MASK) | 
|  | 1153 | if (hldev == NULL) | 
|  | 1154 | return VXGE_TRACE; | 
|  | 1155 | else | 
|  | 1156 | return hldev->level_trace; | 
|  | 1157 | #else | 
|  | 1158 | return 0; | 
|  | 1159 | #endif | 
|  | 1160 | } | 
|  | 1161 | /* | 
|  | 1162 | * vxge_hw_device_debug_mask_get - Get the debug mask | 
|  | 1163 | * This routine returns the current debug mask set | 
|  | 1164 | */ | 
|  | 1165 | u32 vxge_hw_device_debug_mask_get(struct __vxge_hw_device *hldev) | 
|  | 1166 | { | 
|  | 1167 | #if defined(VXGE_DEBUG_TRACE_MASK) || defined(VXGE_DEBUG_ERR_MASK) | 
|  | 1168 | if (hldev == NULL) | 
|  | 1169 | return 0; | 
|  | 1170 | return hldev->debug_module_mask; | 
|  | 1171 | #else | 
|  | 1172 | return 0; | 
|  | 1173 | #endif | 
|  | 1174 | } | 
|  | 1175 |  | 
|  | 1176 | /* | 
|  | 1177 | * vxge_hw_getpause_data -Pause frame frame generation and reception. | 
|  | 1178 | * Returns the Pause frame generation and reception capability of the NIC. | 
|  | 1179 | */ | 
|  | 1180 | enum vxge_hw_status vxge_hw_device_getpause_data(struct __vxge_hw_device *hldev, | 
|  | 1181 | u32 port, u32 *tx, u32 *rx) | 
|  | 1182 | { | 
|  | 1183 | u64 val64; | 
|  | 1184 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 1185 |  | 
|  | 1186 | if ((hldev == NULL) || (hldev->magic != VXGE_HW_DEVICE_MAGIC)) { | 
|  | 1187 | status = VXGE_HW_ERR_INVALID_DEVICE; | 
|  | 1188 | goto exit; | 
|  | 1189 | } | 
|  | 1190 |  | 
|  | 1191 | if (port > VXGE_HW_MAC_MAX_MAC_PORT_ID) { | 
|  | 1192 | status = VXGE_HW_ERR_INVALID_PORT; | 
|  | 1193 | goto exit; | 
|  | 1194 | } | 
|  | 1195 |  | 
|  | 1196 | if (!(hldev->access_rights & VXGE_HW_DEVICE_ACCESS_RIGHT_MRPCIM)) { | 
|  | 1197 | status = VXGE_HW_ERR_PRIVILAGED_OPEARATION; | 
|  | 1198 | goto exit; | 
|  | 1199 | } | 
|  | 1200 |  | 
|  | 1201 | val64 = readq(&hldev->mrpcim_reg->rxmac_pause_cfg_port[port]); | 
|  | 1202 | if (val64 & VXGE_HW_RXMAC_PAUSE_CFG_PORT_GEN_EN) | 
|  | 1203 | *tx = 1; | 
|  | 1204 | if (val64 & VXGE_HW_RXMAC_PAUSE_CFG_PORT_RCV_EN) | 
|  | 1205 | *rx = 1; | 
|  | 1206 | exit: | 
|  | 1207 | return status; | 
|  | 1208 | } | 
|  | 1209 |  | 
|  | 1210 | /* | 
|  | 1211 | * vxge_hw_device_setpause_data -  set/reset pause frame generation. | 
|  | 1212 | * It can be used to set or reset Pause frame generation or reception | 
|  | 1213 | * support of the NIC. | 
|  | 1214 | */ | 
|  | 1215 |  | 
|  | 1216 | enum vxge_hw_status vxge_hw_device_setpause_data(struct __vxge_hw_device *hldev, | 
|  | 1217 | u32 port, u32 tx, u32 rx) | 
|  | 1218 | { | 
|  | 1219 | u64 val64; | 
|  | 1220 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 1221 |  | 
|  | 1222 | if ((hldev == NULL) || (hldev->magic != VXGE_HW_DEVICE_MAGIC)) { | 
|  | 1223 | status = VXGE_HW_ERR_INVALID_DEVICE; | 
|  | 1224 | goto exit; | 
|  | 1225 | } | 
|  | 1226 |  | 
|  | 1227 | if (port > VXGE_HW_MAC_MAX_MAC_PORT_ID) { | 
|  | 1228 | status = VXGE_HW_ERR_INVALID_PORT; | 
|  | 1229 | goto exit; | 
|  | 1230 | } | 
|  | 1231 |  | 
|  | 1232 | status = __vxge_hw_device_is_privilaged(hldev); | 
|  | 1233 | if (status != VXGE_HW_OK) | 
|  | 1234 | goto exit; | 
|  | 1235 |  | 
|  | 1236 | val64 = readq(&hldev->mrpcim_reg->rxmac_pause_cfg_port[port]); | 
|  | 1237 | if (tx) | 
|  | 1238 | val64 |= VXGE_HW_RXMAC_PAUSE_CFG_PORT_GEN_EN; | 
|  | 1239 | else | 
|  | 1240 | val64 &= ~VXGE_HW_RXMAC_PAUSE_CFG_PORT_GEN_EN; | 
|  | 1241 | if (rx) | 
|  | 1242 | val64 |= VXGE_HW_RXMAC_PAUSE_CFG_PORT_RCV_EN; | 
|  | 1243 | else | 
|  | 1244 | val64 &= ~VXGE_HW_RXMAC_PAUSE_CFG_PORT_RCV_EN; | 
|  | 1245 |  | 
|  | 1246 | writeq(val64, &hldev->mrpcim_reg->rxmac_pause_cfg_port[port]); | 
|  | 1247 | exit: | 
|  | 1248 | return status; | 
|  | 1249 | } | 
|  | 1250 |  | 
|  | 1251 | u16 vxge_hw_device_link_width_get(struct __vxge_hw_device *hldev) | 
|  | 1252 | { | 
|  | 1253 | int link_width, exp_cap; | 
|  | 1254 | u16 lnk; | 
|  | 1255 |  | 
|  | 1256 | exp_cap = pci_find_capability(hldev->pdev, PCI_CAP_ID_EXP); | 
|  | 1257 | pci_read_config_word(hldev->pdev, exp_cap + PCI_EXP_LNKSTA, &lnk); | 
|  | 1258 | link_width = (lnk & VXGE_HW_PCI_EXP_LNKCAP_LNK_WIDTH) >> 4; | 
|  | 1259 | return link_width; | 
|  | 1260 | } | 
|  | 1261 |  | 
|  | 1262 | /* | 
|  | 1263 | * __vxge_hw_ring_block_memblock_idx - Return the memblock index | 
|  | 1264 | * This function returns the index of memory block | 
|  | 1265 | */ | 
|  | 1266 | static inline u32 | 
|  | 1267 | __vxge_hw_ring_block_memblock_idx(u8 *block) | 
|  | 1268 | { | 
|  | 1269 | return (u32)*((u64 *)(block + VXGE_HW_RING_MEMBLOCK_IDX_OFFSET)); | 
|  | 1270 | } | 
|  | 1271 |  | 
|  | 1272 | /* | 
|  | 1273 | * __vxge_hw_ring_block_memblock_idx_set - Sets the memblock index | 
|  | 1274 | * This function sets index to a memory block | 
|  | 1275 | */ | 
|  | 1276 | static inline void | 
|  | 1277 | __vxge_hw_ring_block_memblock_idx_set(u8 *block, u32 memblock_idx) | 
|  | 1278 | { | 
|  | 1279 | *((u64 *)(block + VXGE_HW_RING_MEMBLOCK_IDX_OFFSET)) = memblock_idx; | 
|  | 1280 | } | 
|  | 1281 |  | 
|  | 1282 | /* | 
|  | 1283 | * __vxge_hw_ring_block_next_pointer_set - Sets the next block pointer | 
|  | 1284 | * in RxD block | 
|  | 1285 | * Sets the next block pointer in RxD block | 
|  | 1286 | */ | 
|  | 1287 | static inline void | 
|  | 1288 | __vxge_hw_ring_block_next_pointer_set(u8 *block, dma_addr_t dma_next) | 
|  | 1289 | { | 
|  | 1290 | *((u64 *)(block + VXGE_HW_RING_NEXT_BLOCK_POINTER_OFFSET)) = dma_next; | 
|  | 1291 | } | 
|  | 1292 |  | 
|  | 1293 | /* | 
|  | 1294 | * __vxge_hw_ring_first_block_address_get - Returns the dma address of the | 
|  | 1295 | *             first block | 
|  | 1296 | * Returns the dma address of the first RxD block | 
|  | 1297 | */ | 
|  | 1298 | u64 __vxge_hw_ring_first_block_address_get(struct __vxge_hw_ring *ring) | 
|  | 1299 | { | 
|  | 1300 | struct vxge_hw_mempool_dma *dma_object; | 
|  | 1301 |  | 
|  | 1302 | dma_object = ring->mempool->memblocks_dma_arr; | 
|  | 1303 | vxge_assert(dma_object != NULL); | 
|  | 1304 |  | 
|  | 1305 | return dma_object->addr; | 
|  | 1306 | } | 
|  | 1307 |  | 
|  | 1308 | /* | 
|  | 1309 | * __vxge_hw_ring_item_dma_addr - Return the dma address of an item | 
|  | 1310 | * This function returns the dma address of a given item | 
|  | 1311 | */ | 
|  | 1312 | static dma_addr_t __vxge_hw_ring_item_dma_addr(struct vxge_hw_mempool *mempoolh, | 
|  | 1313 | void *item) | 
|  | 1314 | { | 
|  | 1315 | u32 memblock_idx; | 
|  | 1316 | void *memblock; | 
|  | 1317 | struct vxge_hw_mempool_dma *memblock_dma_object; | 
|  | 1318 | ptrdiff_t dma_item_offset; | 
|  | 1319 |  | 
|  | 1320 | /* get owner memblock index */ | 
|  | 1321 | memblock_idx = __vxge_hw_ring_block_memblock_idx(item); | 
|  | 1322 |  | 
|  | 1323 | /* get owner memblock by memblock index */ | 
|  | 1324 | memblock = mempoolh->memblocks_arr[memblock_idx]; | 
|  | 1325 |  | 
|  | 1326 | /* get memblock DMA object by memblock index */ | 
|  | 1327 | memblock_dma_object = mempoolh->memblocks_dma_arr + memblock_idx; | 
|  | 1328 |  | 
|  | 1329 | /* calculate offset in the memblock of this item */ | 
|  | 1330 | dma_item_offset = (u8 *)item - (u8 *)memblock; | 
|  | 1331 |  | 
|  | 1332 | return memblock_dma_object->addr + dma_item_offset; | 
|  | 1333 | } | 
|  | 1334 |  | 
|  | 1335 | /* | 
|  | 1336 | * __vxge_hw_ring_rxdblock_link - Link the RxD blocks | 
|  | 1337 | * This function returns the dma address of a given item | 
|  | 1338 | */ | 
|  | 1339 | static void __vxge_hw_ring_rxdblock_link(struct vxge_hw_mempool *mempoolh, | 
|  | 1340 | struct __vxge_hw_ring *ring, u32 from, | 
|  | 1341 | u32 to) | 
|  | 1342 | { | 
|  | 1343 | u8 *to_item , *from_item; | 
|  | 1344 | dma_addr_t to_dma; | 
|  | 1345 |  | 
|  | 1346 | /* get "from" RxD block */ | 
|  | 1347 | from_item = mempoolh->items_arr[from]; | 
|  | 1348 | vxge_assert(from_item); | 
|  | 1349 |  | 
|  | 1350 | /* get "to" RxD block */ | 
|  | 1351 | to_item = mempoolh->items_arr[to]; | 
|  | 1352 | vxge_assert(to_item); | 
|  | 1353 |  | 
|  | 1354 | /* return address of the beginning of previous RxD block */ | 
|  | 1355 | to_dma = __vxge_hw_ring_item_dma_addr(mempoolh, to_item); | 
|  | 1356 |  | 
|  | 1357 | /* set next pointer for this RxD block to point on | 
|  | 1358 | * previous item's DMA start address */ | 
|  | 1359 | __vxge_hw_ring_block_next_pointer_set(from_item, to_dma); | 
|  | 1360 | } | 
|  | 1361 |  | 
|  | 1362 | /* | 
|  | 1363 | * __vxge_hw_ring_mempool_item_alloc - Allocate List blocks for RxD | 
|  | 1364 | * block callback | 
|  | 1365 | * This function is callback passed to __vxge_hw_mempool_create to create memory | 
|  | 1366 | * pool for RxD block | 
|  | 1367 | */ | 
|  | 1368 | static void | 
|  | 1369 | __vxge_hw_ring_mempool_item_alloc(struct vxge_hw_mempool *mempoolh, | 
|  | 1370 | u32 memblock_index, | 
|  | 1371 | struct vxge_hw_mempool_dma *dma_object, | 
|  | 1372 | u32 index, u32 is_last) | 
|  | 1373 | { | 
|  | 1374 | u32 i; | 
|  | 1375 | void *item = mempoolh->items_arr[index]; | 
|  | 1376 | struct __vxge_hw_ring *ring = | 
|  | 1377 | (struct __vxge_hw_ring *)mempoolh->userdata; | 
|  | 1378 |  | 
|  | 1379 | /* format rxds array */ | 
|  | 1380 | for (i = 0; i < ring->rxds_per_block; i++) { | 
|  | 1381 | void *rxdblock_priv; | 
|  | 1382 | void *uld_priv; | 
|  | 1383 | struct vxge_hw_ring_rxd_1 *rxdp; | 
|  | 1384 |  | 
|  | 1385 | u32 reserve_index = ring->channel.reserve_ptr - | 
|  | 1386 | (index * ring->rxds_per_block + i + 1); | 
|  | 1387 | u32 memblock_item_idx; | 
|  | 1388 |  | 
|  | 1389 | ring->channel.reserve_arr[reserve_index] = ((u8 *)item) + | 
|  | 1390 | i * ring->rxd_size; | 
|  | 1391 |  | 
|  | 1392 | /* Note: memblock_item_idx is index of the item within | 
|  | 1393 | *       the memblock. For instance, in case of three RxD-blocks | 
|  | 1394 | *       per memblock this value can be 0, 1 or 2. */ | 
|  | 1395 | rxdblock_priv = __vxge_hw_mempool_item_priv(mempoolh, | 
|  | 1396 | memblock_index, item, | 
|  | 1397 | &memblock_item_idx); | 
|  | 1398 |  | 
|  | 1399 | rxdp = (struct vxge_hw_ring_rxd_1 *) | 
|  | 1400 | ring->channel.reserve_arr[reserve_index]; | 
|  | 1401 |  | 
|  | 1402 | uld_priv = ((u8 *)rxdblock_priv + ring->rxd_priv_size * i); | 
|  | 1403 |  | 
|  | 1404 | /* pre-format Host_Control */ | 
|  | 1405 | rxdp->host_control = (u64)(size_t)uld_priv; | 
|  | 1406 | } | 
|  | 1407 |  | 
|  | 1408 | __vxge_hw_ring_block_memblock_idx_set(item, memblock_index); | 
|  | 1409 |  | 
|  | 1410 | if (is_last) { | 
|  | 1411 | /* link last one with first one */ | 
|  | 1412 | __vxge_hw_ring_rxdblock_link(mempoolh, ring, index, 0); | 
|  | 1413 | } | 
|  | 1414 |  | 
|  | 1415 | if (index > 0) { | 
|  | 1416 | /* link this RxD block with previous one */ | 
|  | 1417 | __vxge_hw_ring_rxdblock_link(mempoolh, ring, index - 1, index); | 
|  | 1418 | } | 
|  | 1419 |  | 
|  | 1420 | return; | 
|  | 1421 | } | 
|  | 1422 |  | 
|  | 1423 | /* | 
|  | 1424 | * __vxge_hw_ring_initial_replenish - Initial replenish of RxDs | 
|  | 1425 | * This function replenishes the RxDs from reserve array to work array | 
|  | 1426 | */ | 
|  | 1427 | enum vxge_hw_status | 
|  | 1428 | vxge_hw_ring_replenish(struct __vxge_hw_ring *ring, u16 min_flag) | 
|  | 1429 | { | 
|  | 1430 | void *rxd; | 
|  | 1431 | int i = 0; | 
|  | 1432 | struct __vxge_hw_channel *channel; | 
|  | 1433 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 1434 |  | 
|  | 1435 | channel = &ring->channel; | 
|  | 1436 |  | 
|  | 1437 | while (vxge_hw_channel_dtr_count(channel) > 0) { | 
|  | 1438 |  | 
|  | 1439 | status = vxge_hw_ring_rxd_reserve(ring, &rxd); | 
|  | 1440 |  | 
|  | 1441 | vxge_assert(status == VXGE_HW_OK); | 
|  | 1442 |  | 
|  | 1443 | if (ring->rxd_init) { | 
|  | 1444 | status = ring->rxd_init(rxd, channel->userdata); | 
|  | 1445 | if (status != VXGE_HW_OK) { | 
|  | 1446 | vxge_hw_ring_rxd_free(ring, rxd); | 
|  | 1447 | goto exit; | 
|  | 1448 | } | 
|  | 1449 | } | 
|  | 1450 |  | 
|  | 1451 | vxge_hw_ring_rxd_post(ring, rxd); | 
|  | 1452 | if (min_flag) { | 
|  | 1453 | i++; | 
|  | 1454 | if (i == VXGE_HW_RING_MIN_BUFF_ALLOCATION) | 
|  | 1455 | break; | 
|  | 1456 | } | 
|  | 1457 | } | 
|  | 1458 | status = VXGE_HW_OK; | 
|  | 1459 | exit: | 
|  | 1460 | return status; | 
|  | 1461 | } | 
|  | 1462 |  | 
|  | 1463 | /* | 
|  | 1464 | * __vxge_hw_ring_create - Create a Ring | 
|  | 1465 | * This function creates Ring and initializes it. | 
|  | 1466 | * | 
|  | 1467 | */ | 
|  | 1468 | enum vxge_hw_status | 
|  | 1469 | __vxge_hw_ring_create(struct __vxge_hw_vpath_handle *vp, | 
|  | 1470 | struct vxge_hw_ring_attr *attr) | 
|  | 1471 | { | 
|  | 1472 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 1473 | struct __vxge_hw_ring *ring; | 
|  | 1474 | u32 ring_length; | 
|  | 1475 | struct vxge_hw_ring_config *config; | 
|  | 1476 | struct __vxge_hw_device *hldev; | 
|  | 1477 | u32 vp_id; | 
|  | 1478 | struct vxge_hw_mempool_cbs ring_mp_callback; | 
|  | 1479 |  | 
|  | 1480 | if ((vp == NULL) || (attr == NULL)) { | 
|  | 1481 | status = VXGE_HW_FAIL; | 
|  | 1482 | goto exit; | 
|  | 1483 | } | 
|  | 1484 |  | 
|  | 1485 | hldev = vp->vpath->hldev; | 
|  | 1486 | vp_id = vp->vpath->vp_id; | 
|  | 1487 |  | 
|  | 1488 | config = &hldev->config.vp_config[vp_id].ring; | 
|  | 1489 |  | 
|  | 1490 | ring_length = config->ring_blocks * | 
|  | 1491 | vxge_hw_ring_rxds_per_block_get(config->buffer_mode); | 
|  | 1492 |  | 
|  | 1493 | ring = (struct __vxge_hw_ring *)__vxge_hw_channel_allocate(vp, | 
|  | 1494 | VXGE_HW_CHANNEL_TYPE_RING, | 
|  | 1495 | ring_length, | 
|  | 1496 | attr->per_rxd_space, | 
|  | 1497 | attr->userdata); | 
|  | 1498 |  | 
|  | 1499 | if (ring == NULL) { | 
|  | 1500 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 1501 | goto exit; | 
|  | 1502 | } | 
|  | 1503 |  | 
|  | 1504 | vp->vpath->ringh = ring; | 
|  | 1505 | ring->vp_id = vp_id; | 
|  | 1506 | ring->vp_reg = vp->vpath->vp_reg; | 
|  | 1507 | ring->common_reg = hldev->common_reg; | 
|  | 1508 | ring->stats = &vp->vpath->sw_stats->ring_stats; | 
|  | 1509 | ring->config = config; | 
|  | 1510 | ring->callback = attr->callback; | 
|  | 1511 | ring->rxd_init = attr->rxd_init; | 
|  | 1512 | ring->rxd_term = attr->rxd_term; | 
|  | 1513 | ring->buffer_mode = config->buffer_mode; | 
|  | 1514 | ring->rxds_limit = config->rxds_limit; | 
|  | 1515 |  | 
|  | 1516 | ring->rxd_size = vxge_hw_ring_rxd_size_get(config->buffer_mode); | 
|  | 1517 | ring->rxd_priv_size = | 
|  | 1518 | sizeof(struct __vxge_hw_ring_rxd_priv) + attr->per_rxd_space; | 
|  | 1519 | ring->per_rxd_space = attr->per_rxd_space; | 
|  | 1520 |  | 
|  | 1521 | ring->rxd_priv_size = | 
|  | 1522 | ((ring->rxd_priv_size + VXGE_CACHE_LINE_SIZE - 1) / | 
|  | 1523 | VXGE_CACHE_LINE_SIZE) * VXGE_CACHE_LINE_SIZE; | 
|  | 1524 |  | 
|  | 1525 | /* how many RxDs can fit into one block. Depends on configured | 
|  | 1526 | * buffer_mode. */ | 
|  | 1527 | ring->rxds_per_block = | 
|  | 1528 | vxge_hw_ring_rxds_per_block_get(config->buffer_mode); | 
|  | 1529 |  | 
|  | 1530 | /* calculate actual RxD block private size */ | 
|  | 1531 | ring->rxdblock_priv_size = ring->rxd_priv_size * ring->rxds_per_block; | 
|  | 1532 | ring_mp_callback.item_func_alloc = __vxge_hw_ring_mempool_item_alloc; | 
|  | 1533 | ring->mempool = __vxge_hw_mempool_create(hldev, | 
|  | 1534 | VXGE_HW_BLOCK_SIZE, | 
|  | 1535 | VXGE_HW_BLOCK_SIZE, | 
|  | 1536 | ring->rxdblock_priv_size, | 
|  | 1537 | ring->config->ring_blocks, | 
|  | 1538 | ring->config->ring_blocks, | 
|  | 1539 | &ring_mp_callback, | 
|  | 1540 | ring); | 
|  | 1541 |  | 
|  | 1542 | if (ring->mempool == NULL) { | 
|  | 1543 | __vxge_hw_ring_delete(vp); | 
|  | 1544 | return VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 1545 | } | 
|  | 1546 |  | 
|  | 1547 | status = __vxge_hw_channel_initialize(&ring->channel); | 
|  | 1548 | if (status != VXGE_HW_OK) { | 
|  | 1549 | __vxge_hw_ring_delete(vp); | 
|  | 1550 | goto exit; | 
|  | 1551 | } | 
|  | 1552 |  | 
|  | 1553 | /* Note: | 
|  | 1554 | * Specifying rxd_init callback means two things: | 
|  | 1555 | * 1) rxds need to be initialized by driver at channel-open time; | 
|  | 1556 | * 2) rxds need to be posted at channel-open time | 
|  | 1557 | *    (that's what the initial_replenish() below does) | 
|  | 1558 | * Currently we don't have a case when the 1) is done without the 2). | 
|  | 1559 | */ | 
|  | 1560 | if (ring->rxd_init) { | 
|  | 1561 | status = vxge_hw_ring_replenish(ring, 1); | 
|  | 1562 | if (status != VXGE_HW_OK) { | 
|  | 1563 | __vxge_hw_ring_delete(vp); | 
|  | 1564 | goto exit; | 
|  | 1565 | } | 
|  | 1566 | } | 
|  | 1567 |  | 
|  | 1568 | /* initial replenish will increment the counter in its post() routine, | 
|  | 1569 | * we have to reset it */ | 
|  | 1570 | ring->stats->common_stats.usage_cnt = 0; | 
|  | 1571 | exit: | 
|  | 1572 | return status; | 
|  | 1573 | } | 
|  | 1574 |  | 
|  | 1575 | /* | 
|  | 1576 | * __vxge_hw_ring_abort - Returns the RxD | 
|  | 1577 | * This function terminates the RxDs of ring | 
|  | 1578 | */ | 
|  | 1579 | enum vxge_hw_status __vxge_hw_ring_abort(struct __vxge_hw_ring *ring) | 
|  | 1580 | { | 
|  | 1581 | void *rxdh; | 
|  | 1582 | struct __vxge_hw_channel *channel; | 
|  | 1583 |  | 
|  | 1584 | channel = &ring->channel; | 
|  | 1585 |  | 
|  | 1586 | for (;;) { | 
|  | 1587 | vxge_hw_channel_dtr_try_complete(channel, &rxdh); | 
|  | 1588 |  | 
|  | 1589 | if (rxdh == NULL) | 
|  | 1590 | break; | 
|  | 1591 |  | 
|  | 1592 | vxge_hw_channel_dtr_complete(channel); | 
|  | 1593 |  | 
|  | 1594 | if (ring->rxd_term) | 
|  | 1595 | ring->rxd_term(rxdh, VXGE_HW_RXD_STATE_POSTED, | 
|  | 1596 | channel->userdata); | 
|  | 1597 |  | 
|  | 1598 | vxge_hw_channel_dtr_free(channel, rxdh); | 
|  | 1599 | } | 
|  | 1600 |  | 
|  | 1601 | return VXGE_HW_OK; | 
|  | 1602 | } | 
|  | 1603 |  | 
|  | 1604 | /* | 
|  | 1605 | * __vxge_hw_ring_reset - Resets the ring | 
|  | 1606 | * This function resets the ring during vpath reset operation | 
|  | 1607 | */ | 
|  | 1608 | enum vxge_hw_status __vxge_hw_ring_reset(struct __vxge_hw_ring *ring) | 
|  | 1609 | { | 
|  | 1610 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 1611 | struct __vxge_hw_channel *channel; | 
|  | 1612 |  | 
|  | 1613 | channel = &ring->channel; | 
|  | 1614 |  | 
|  | 1615 | __vxge_hw_ring_abort(ring); | 
|  | 1616 |  | 
|  | 1617 | status = __vxge_hw_channel_reset(channel); | 
|  | 1618 |  | 
|  | 1619 | if (status != VXGE_HW_OK) | 
|  | 1620 | goto exit; | 
|  | 1621 |  | 
|  | 1622 | if (ring->rxd_init) { | 
|  | 1623 | status = vxge_hw_ring_replenish(ring, 1); | 
|  | 1624 | if (status != VXGE_HW_OK) | 
|  | 1625 | goto exit; | 
|  | 1626 | } | 
|  | 1627 | exit: | 
|  | 1628 | return status; | 
|  | 1629 | } | 
|  | 1630 |  | 
|  | 1631 | /* | 
|  | 1632 | * __vxge_hw_ring_delete - Removes the ring | 
|  | 1633 | * This function freeup the memory pool and removes the ring | 
|  | 1634 | */ | 
|  | 1635 | enum vxge_hw_status __vxge_hw_ring_delete(struct __vxge_hw_vpath_handle *vp) | 
|  | 1636 | { | 
|  | 1637 | struct __vxge_hw_ring *ring = vp->vpath->ringh; | 
|  | 1638 |  | 
|  | 1639 | __vxge_hw_ring_abort(ring); | 
|  | 1640 |  | 
|  | 1641 | if (ring->mempool) | 
|  | 1642 | __vxge_hw_mempool_destroy(ring->mempool); | 
|  | 1643 |  | 
|  | 1644 | vp->vpath->ringh = NULL; | 
|  | 1645 | __vxge_hw_channel_free(&ring->channel); | 
|  | 1646 |  | 
|  | 1647 | return VXGE_HW_OK; | 
|  | 1648 | } | 
|  | 1649 |  | 
|  | 1650 | /* | 
|  | 1651 | * __vxge_hw_mempool_grow | 
|  | 1652 | * Will resize mempool up to %num_allocate value. | 
|  | 1653 | */ | 
|  | 1654 | enum vxge_hw_status | 
|  | 1655 | __vxge_hw_mempool_grow(struct vxge_hw_mempool *mempool, u32 num_allocate, | 
|  | 1656 | u32 *num_allocated) | 
|  | 1657 | { | 
|  | 1658 | u32 i, first_time = mempool->memblocks_allocated == 0 ? 1 : 0; | 
|  | 1659 | u32 n_items = mempool->items_per_memblock; | 
|  | 1660 | u32 start_block_idx = mempool->memblocks_allocated; | 
|  | 1661 | u32 end_block_idx = mempool->memblocks_allocated + num_allocate; | 
|  | 1662 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 1663 |  | 
|  | 1664 | *num_allocated = 0; | 
|  | 1665 |  | 
|  | 1666 | if (end_block_idx > mempool->memblocks_max) { | 
|  | 1667 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 1668 | goto exit; | 
|  | 1669 | } | 
|  | 1670 |  | 
|  | 1671 | for (i = start_block_idx; i < end_block_idx; i++) { | 
|  | 1672 | u32 j; | 
|  | 1673 | u32 is_last = ((end_block_idx - 1) == i); | 
|  | 1674 | struct vxge_hw_mempool_dma *dma_object = | 
|  | 1675 | mempool->memblocks_dma_arr + i; | 
|  | 1676 | void *the_memblock; | 
|  | 1677 |  | 
|  | 1678 | /* allocate memblock's private part. Each DMA memblock | 
|  | 1679 | * has a space allocated for item's private usage upon | 
|  | 1680 | * mempool's user request. Each time mempool grows, it will | 
|  | 1681 | * allocate new memblock and its private part at once. | 
|  | 1682 | * This helps to minimize memory usage a lot. */ | 
|  | 1683 | mempool->memblocks_priv_arr[i] = | 
|  | 1684 | vmalloc(mempool->items_priv_size * n_items); | 
|  | 1685 | if (mempool->memblocks_priv_arr[i] == NULL) { | 
|  | 1686 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 1687 | goto exit; | 
|  | 1688 | } | 
|  | 1689 |  | 
|  | 1690 | memset(mempool->memblocks_priv_arr[i], 0, | 
|  | 1691 | mempool->items_priv_size * n_items); | 
|  | 1692 |  | 
|  | 1693 | /* allocate DMA-capable memblock */ | 
|  | 1694 | mempool->memblocks_arr[i] = | 
|  | 1695 | __vxge_hw_blockpool_malloc(mempool->devh, | 
|  | 1696 | mempool->memblock_size, dma_object); | 
|  | 1697 | if (mempool->memblocks_arr[i] == NULL) { | 
|  | 1698 | vfree(mempool->memblocks_priv_arr[i]); | 
|  | 1699 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 1700 | goto exit; | 
|  | 1701 | } | 
|  | 1702 |  | 
|  | 1703 | (*num_allocated)++; | 
|  | 1704 | mempool->memblocks_allocated++; | 
|  | 1705 |  | 
|  | 1706 | memset(mempool->memblocks_arr[i], 0, mempool->memblock_size); | 
|  | 1707 |  | 
|  | 1708 | the_memblock = mempool->memblocks_arr[i]; | 
|  | 1709 |  | 
|  | 1710 | /* fill the items hash array */ | 
|  | 1711 | for (j = 0; j < n_items; j++) { | 
|  | 1712 | u32 index = i * n_items + j; | 
|  | 1713 |  | 
|  | 1714 | if (first_time && index >= mempool->items_initial) | 
|  | 1715 | break; | 
|  | 1716 |  | 
|  | 1717 | mempool->items_arr[index] = | 
|  | 1718 | ((char *)the_memblock + j*mempool->item_size); | 
|  | 1719 |  | 
|  | 1720 | /* let caller to do more job on each item */ | 
|  | 1721 | if (mempool->item_func_alloc != NULL) | 
|  | 1722 | mempool->item_func_alloc(mempool, i, | 
|  | 1723 | dma_object, index, is_last); | 
|  | 1724 |  | 
|  | 1725 | mempool->items_current = index + 1; | 
|  | 1726 | } | 
|  | 1727 |  | 
|  | 1728 | if (first_time && mempool->items_current == | 
|  | 1729 | mempool->items_initial) | 
|  | 1730 | break; | 
|  | 1731 | } | 
|  | 1732 | exit: | 
|  | 1733 | return status; | 
|  | 1734 | } | 
|  | 1735 |  | 
|  | 1736 | /* | 
|  | 1737 | * vxge_hw_mempool_create | 
|  | 1738 | * This function will create memory pool object. Pool may grow but will | 
|  | 1739 | * never shrink. Pool consists of number of dynamically allocated blocks | 
|  | 1740 | * with size enough to hold %items_initial number of items. Memory is | 
|  | 1741 | * DMA-able but client must map/unmap before interoperating with the device. | 
|  | 1742 | */ | 
|  | 1743 | struct vxge_hw_mempool* | 
|  | 1744 | __vxge_hw_mempool_create( | 
|  | 1745 | struct __vxge_hw_device *devh, | 
|  | 1746 | u32 memblock_size, | 
|  | 1747 | u32 item_size, | 
|  | 1748 | u32 items_priv_size, | 
|  | 1749 | u32 items_initial, | 
|  | 1750 | u32 items_max, | 
|  | 1751 | struct vxge_hw_mempool_cbs *mp_callback, | 
|  | 1752 | void *userdata) | 
|  | 1753 | { | 
|  | 1754 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 1755 | u32 memblocks_to_allocate; | 
|  | 1756 | struct vxge_hw_mempool *mempool = NULL; | 
|  | 1757 | u32 allocated; | 
|  | 1758 |  | 
|  | 1759 | if (memblock_size < item_size) { | 
|  | 1760 | status = VXGE_HW_FAIL; | 
|  | 1761 | goto exit; | 
|  | 1762 | } | 
|  | 1763 |  | 
|  | 1764 | mempool = (struct vxge_hw_mempool *) | 
|  | 1765 | vmalloc(sizeof(struct vxge_hw_mempool)); | 
|  | 1766 | if (mempool == NULL) { | 
|  | 1767 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 1768 | goto exit; | 
|  | 1769 | } | 
|  | 1770 | memset(mempool, 0, sizeof(struct vxge_hw_mempool)); | 
|  | 1771 |  | 
|  | 1772 | mempool->devh			= devh; | 
|  | 1773 | mempool->memblock_size		= memblock_size; | 
|  | 1774 | mempool->items_max		= items_max; | 
|  | 1775 | mempool->items_initial		= items_initial; | 
|  | 1776 | mempool->item_size		= item_size; | 
|  | 1777 | mempool->items_priv_size	= items_priv_size; | 
|  | 1778 | mempool->item_func_alloc	= mp_callback->item_func_alloc; | 
|  | 1779 | mempool->userdata		= userdata; | 
|  | 1780 |  | 
|  | 1781 | mempool->memblocks_allocated = 0; | 
|  | 1782 |  | 
|  | 1783 | mempool->items_per_memblock = memblock_size / item_size; | 
|  | 1784 |  | 
|  | 1785 | mempool->memblocks_max = (items_max + mempool->items_per_memblock - 1) / | 
|  | 1786 | mempool->items_per_memblock; | 
|  | 1787 |  | 
|  | 1788 | /* allocate array of memblocks */ | 
|  | 1789 | mempool->memblocks_arr = | 
|  | 1790 | (void **) vmalloc(sizeof(void *) * mempool->memblocks_max); | 
|  | 1791 | if (mempool->memblocks_arr == NULL) { | 
|  | 1792 | __vxge_hw_mempool_destroy(mempool); | 
|  | 1793 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 1794 | mempool = NULL; | 
|  | 1795 | goto exit; | 
|  | 1796 | } | 
|  | 1797 | memset(mempool->memblocks_arr, 0, | 
|  | 1798 | sizeof(void *) * mempool->memblocks_max); | 
|  | 1799 |  | 
|  | 1800 | /* allocate array of private parts of items per memblocks */ | 
|  | 1801 | mempool->memblocks_priv_arr = | 
|  | 1802 | (void **) vmalloc(sizeof(void *) * mempool->memblocks_max); | 
|  | 1803 | if (mempool->memblocks_priv_arr == NULL) { | 
|  | 1804 | __vxge_hw_mempool_destroy(mempool); | 
|  | 1805 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 1806 | mempool = NULL; | 
|  | 1807 | goto exit; | 
|  | 1808 | } | 
|  | 1809 | memset(mempool->memblocks_priv_arr, 0, | 
|  | 1810 | sizeof(void *) * mempool->memblocks_max); | 
|  | 1811 |  | 
|  | 1812 | /* allocate array of memblocks DMA objects */ | 
|  | 1813 | mempool->memblocks_dma_arr = (struct vxge_hw_mempool_dma *) | 
|  | 1814 | vmalloc(sizeof(struct vxge_hw_mempool_dma) * | 
|  | 1815 | mempool->memblocks_max); | 
|  | 1816 |  | 
|  | 1817 | if (mempool->memblocks_dma_arr == NULL) { | 
|  | 1818 | __vxge_hw_mempool_destroy(mempool); | 
|  | 1819 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 1820 | mempool = NULL; | 
|  | 1821 | goto exit; | 
|  | 1822 | } | 
|  | 1823 | memset(mempool->memblocks_dma_arr, 0, | 
|  | 1824 | sizeof(struct vxge_hw_mempool_dma) * | 
|  | 1825 | mempool->memblocks_max); | 
|  | 1826 |  | 
|  | 1827 | /* allocate hash array of items */ | 
|  | 1828 | mempool->items_arr = | 
|  | 1829 | (void **) vmalloc(sizeof(void *) * mempool->items_max); | 
|  | 1830 | if (mempool->items_arr == NULL) { | 
|  | 1831 | __vxge_hw_mempool_destroy(mempool); | 
|  | 1832 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 1833 | mempool = NULL; | 
|  | 1834 | goto exit; | 
|  | 1835 | } | 
|  | 1836 | memset(mempool->items_arr, 0, sizeof(void *) * mempool->items_max); | 
|  | 1837 |  | 
|  | 1838 | /* calculate initial number of memblocks */ | 
|  | 1839 | memblocks_to_allocate = (mempool->items_initial + | 
|  | 1840 | mempool->items_per_memblock - 1) / | 
|  | 1841 | mempool->items_per_memblock; | 
|  | 1842 |  | 
|  | 1843 | /* pre-allocate the mempool */ | 
|  | 1844 | status = __vxge_hw_mempool_grow(mempool, memblocks_to_allocate, | 
|  | 1845 | &allocated); | 
|  | 1846 | if (status != VXGE_HW_OK) { | 
|  | 1847 | __vxge_hw_mempool_destroy(mempool); | 
|  | 1848 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 1849 | mempool = NULL; | 
|  | 1850 | goto exit; | 
|  | 1851 | } | 
|  | 1852 |  | 
|  | 1853 | exit: | 
|  | 1854 | return mempool; | 
|  | 1855 | } | 
|  | 1856 |  | 
|  | 1857 | /* | 
|  | 1858 | * vxge_hw_mempool_destroy | 
|  | 1859 | */ | 
|  | 1860 | void __vxge_hw_mempool_destroy(struct vxge_hw_mempool *mempool) | 
|  | 1861 | { | 
|  | 1862 | u32 i, j; | 
|  | 1863 | struct __vxge_hw_device *devh = mempool->devh; | 
|  | 1864 |  | 
|  | 1865 | for (i = 0; i < mempool->memblocks_allocated; i++) { | 
|  | 1866 | struct vxge_hw_mempool_dma *dma_object; | 
|  | 1867 |  | 
|  | 1868 | vxge_assert(mempool->memblocks_arr[i]); | 
|  | 1869 | vxge_assert(mempool->memblocks_dma_arr + i); | 
|  | 1870 |  | 
|  | 1871 | dma_object = mempool->memblocks_dma_arr + i; | 
|  | 1872 |  | 
|  | 1873 | for (j = 0; j < mempool->items_per_memblock; j++) { | 
|  | 1874 | u32 index = i * mempool->items_per_memblock + j; | 
|  | 1875 |  | 
|  | 1876 | /* to skip last partially filled(if any) memblock */ | 
|  | 1877 | if (index >= mempool->items_current) | 
|  | 1878 | break; | 
|  | 1879 | } | 
|  | 1880 |  | 
|  | 1881 | vfree(mempool->memblocks_priv_arr[i]); | 
|  | 1882 |  | 
|  | 1883 | __vxge_hw_blockpool_free(devh, mempool->memblocks_arr[i], | 
|  | 1884 | mempool->memblock_size, dma_object); | 
|  | 1885 | } | 
|  | 1886 |  | 
|  | 1887 | if (mempool->items_arr) | 
|  | 1888 | vfree(mempool->items_arr); | 
|  | 1889 |  | 
|  | 1890 | if (mempool->memblocks_dma_arr) | 
|  | 1891 | vfree(mempool->memblocks_dma_arr); | 
|  | 1892 |  | 
|  | 1893 | if (mempool->memblocks_priv_arr) | 
|  | 1894 | vfree(mempool->memblocks_priv_arr); | 
|  | 1895 |  | 
|  | 1896 | if (mempool->memblocks_arr) | 
|  | 1897 | vfree(mempool->memblocks_arr); | 
|  | 1898 |  | 
|  | 1899 | vfree(mempool); | 
|  | 1900 | } | 
|  | 1901 |  | 
|  | 1902 | /* | 
|  | 1903 | * __vxge_hw_device_fifo_config_check - Check fifo configuration. | 
|  | 1904 | * Check the fifo configuration | 
|  | 1905 | */ | 
|  | 1906 | enum vxge_hw_status | 
|  | 1907 | __vxge_hw_device_fifo_config_check(struct vxge_hw_fifo_config *fifo_config) | 
|  | 1908 | { | 
|  | 1909 | if ((fifo_config->fifo_blocks < VXGE_HW_MIN_FIFO_BLOCKS) || | 
|  | 1910 | (fifo_config->fifo_blocks > VXGE_HW_MAX_FIFO_BLOCKS)) | 
|  | 1911 | return VXGE_HW_BADCFG_FIFO_BLOCKS; | 
|  | 1912 |  | 
|  | 1913 | return VXGE_HW_OK; | 
|  | 1914 | } | 
|  | 1915 |  | 
|  | 1916 | /* | 
|  | 1917 | * __vxge_hw_device_vpath_config_check - Check vpath configuration. | 
|  | 1918 | * Check the vpath configuration | 
|  | 1919 | */ | 
|  | 1920 | enum vxge_hw_status | 
|  | 1921 | __vxge_hw_device_vpath_config_check(struct vxge_hw_vp_config *vp_config) | 
|  | 1922 | { | 
|  | 1923 | enum vxge_hw_status status; | 
|  | 1924 |  | 
|  | 1925 | if ((vp_config->min_bandwidth < VXGE_HW_VPATH_BANDWIDTH_MIN) || | 
|  | 1926 | (vp_config->min_bandwidth > | 
|  | 1927 | VXGE_HW_VPATH_BANDWIDTH_MAX)) | 
|  | 1928 | return VXGE_HW_BADCFG_VPATH_MIN_BANDWIDTH; | 
|  | 1929 |  | 
|  | 1930 | status = __vxge_hw_device_fifo_config_check(&vp_config->fifo); | 
|  | 1931 | if (status != VXGE_HW_OK) | 
|  | 1932 | return status; | 
|  | 1933 |  | 
|  | 1934 | if ((vp_config->mtu != VXGE_HW_VPATH_USE_FLASH_DEFAULT_INITIAL_MTU) && | 
|  | 1935 | ((vp_config->mtu < VXGE_HW_VPATH_MIN_INITIAL_MTU) || | 
|  | 1936 | (vp_config->mtu > VXGE_HW_VPATH_MAX_INITIAL_MTU))) | 
|  | 1937 | return VXGE_HW_BADCFG_VPATH_MTU; | 
|  | 1938 |  | 
|  | 1939 | if ((vp_config->rpa_strip_vlan_tag != | 
|  | 1940 | VXGE_HW_VPATH_RPA_STRIP_VLAN_TAG_USE_FLASH_DEFAULT) && | 
|  | 1941 | (vp_config->rpa_strip_vlan_tag != | 
|  | 1942 | VXGE_HW_VPATH_RPA_STRIP_VLAN_TAG_ENABLE) && | 
|  | 1943 | (vp_config->rpa_strip_vlan_tag != | 
|  | 1944 | VXGE_HW_VPATH_RPA_STRIP_VLAN_TAG_DISABLE)) | 
|  | 1945 | return VXGE_HW_BADCFG_VPATH_RPA_STRIP_VLAN_TAG; | 
|  | 1946 |  | 
|  | 1947 | return VXGE_HW_OK; | 
|  | 1948 | } | 
|  | 1949 |  | 
|  | 1950 | /* | 
|  | 1951 | * __vxge_hw_device_config_check - Check device configuration. | 
|  | 1952 | * Check the device configuration | 
|  | 1953 | */ | 
|  | 1954 | enum vxge_hw_status | 
|  | 1955 | __vxge_hw_device_config_check(struct vxge_hw_device_config *new_config) | 
|  | 1956 | { | 
|  | 1957 | u32 i; | 
|  | 1958 | enum vxge_hw_status status; | 
|  | 1959 |  | 
|  | 1960 | if ((new_config->intr_mode != VXGE_HW_INTR_MODE_IRQLINE) && | 
|  | 1961 | (new_config->intr_mode != VXGE_HW_INTR_MODE_MSIX) && | 
|  | 1962 | (new_config->intr_mode != VXGE_HW_INTR_MODE_MSIX_ONE_SHOT) && | 
|  | 1963 | (new_config->intr_mode != VXGE_HW_INTR_MODE_DEF)) | 
|  | 1964 | return VXGE_HW_BADCFG_INTR_MODE; | 
|  | 1965 |  | 
|  | 1966 | if ((new_config->rts_mac_en != VXGE_HW_RTS_MAC_DISABLE) && | 
|  | 1967 | (new_config->rts_mac_en != VXGE_HW_RTS_MAC_ENABLE)) | 
|  | 1968 | return VXGE_HW_BADCFG_RTS_MAC_EN; | 
|  | 1969 |  | 
|  | 1970 | for (i = 0; i < VXGE_HW_MAX_VIRTUAL_PATHS; i++) { | 
|  | 1971 | status = __vxge_hw_device_vpath_config_check( | 
|  | 1972 | &new_config->vp_config[i]); | 
|  | 1973 | if (status != VXGE_HW_OK) | 
|  | 1974 | return status; | 
|  | 1975 | } | 
|  | 1976 |  | 
|  | 1977 | return VXGE_HW_OK; | 
|  | 1978 | } | 
|  | 1979 |  | 
|  | 1980 | /* | 
|  | 1981 | * vxge_hw_device_config_default_get - Initialize device config with defaults. | 
|  | 1982 | * Initialize Titan device config with default values. | 
|  | 1983 | */ | 
|  | 1984 | enum vxge_hw_status __devinit | 
|  | 1985 | vxge_hw_device_config_default_get(struct vxge_hw_device_config *device_config) | 
|  | 1986 | { | 
|  | 1987 | u32 i; | 
|  | 1988 |  | 
|  | 1989 | device_config->dma_blockpool_initial = | 
|  | 1990 | VXGE_HW_INITIAL_DMA_BLOCK_POOL_SIZE; | 
|  | 1991 | device_config->dma_blockpool_max = VXGE_HW_MAX_DMA_BLOCK_POOL_SIZE; | 
|  | 1992 | device_config->intr_mode = VXGE_HW_INTR_MODE_DEF; | 
|  | 1993 | device_config->rth_en = VXGE_HW_RTH_DEFAULT; | 
|  | 1994 | device_config->rth_it_type = VXGE_HW_RTH_IT_TYPE_DEFAULT; | 
|  | 1995 | device_config->device_poll_millis =  VXGE_HW_DEF_DEVICE_POLL_MILLIS; | 
|  | 1996 | device_config->rts_mac_en =  VXGE_HW_RTS_MAC_DEFAULT; | 
|  | 1997 |  | 
|  | 1998 | for (i = 0; i < VXGE_HW_MAX_VIRTUAL_PATHS; i++) { | 
|  | 1999 |  | 
|  | 2000 | device_config->vp_config[i].vp_id = i; | 
|  | 2001 |  | 
|  | 2002 | device_config->vp_config[i].min_bandwidth = | 
|  | 2003 | VXGE_HW_VPATH_BANDWIDTH_DEFAULT; | 
|  | 2004 |  | 
|  | 2005 | device_config->vp_config[i].ring.enable = VXGE_HW_RING_DEFAULT; | 
|  | 2006 |  | 
|  | 2007 | device_config->vp_config[i].ring.ring_blocks = | 
|  | 2008 | VXGE_HW_DEF_RING_BLOCKS; | 
|  | 2009 |  | 
|  | 2010 | device_config->vp_config[i].ring.buffer_mode = | 
|  | 2011 | VXGE_HW_RING_RXD_BUFFER_MODE_DEFAULT; | 
|  | 2012 |  | 
|  | 2013 | device_config->vp_config[i].ring.scatter_mode = | 
|  | 2014 | VXGE_HW_RING_SCATTER_MODE_USE_FLASH_DEFAULT; | 
|  | 2015 |  | 
|  | 2016 | device_config->vp_config[i].ring.rxds_limit = | 
|  | 2017 | VXGE_HW_DEF_RING_RXDS_LIMIT; | 
|  | 2018 |  | 
|  | 2019 | device_config->vp_config[i].fifo.enable = VXGE_HW_FIFO_ENABLE; | 
|  | 2020 |  | 
|  | 2021 | device_config->vp_config[i].fifo.fifo_blocks = | 
|  | 2022 | VXGE_HW_MIN_FIFO_BLOCKS; | 
|  | 2023 |  | 
|  | 2024 | device_config->vp_config[i].fifo.max_frags = | 
|  | 2025 | VXGE_HW_MAX_FIFO_FRAGS; | 
|  | 2026 |  | 
|  | 2027 | device_config->vp_config[i].fifo.memblock_size = | 
|  | 2028 | VXGE_HW_DEF_FIFO_MEMBLOCK_SIZE; | 
|  | 2029 |  | 
|  | 2030 | device_config->vp_config[i].fifo.alignment_size = | 
|  | 2031 | VXGE_HW_DEF_FIFO_ALIGNMENT_SIZE; | 
|  | 2032 |  | 
|  | 2033 | device_config->vp_config[i].fifo.intr = | 
|  | 2034 | VXGE_HW_FIFO_QUEUE_INTR_DEFAULT; | 
|  | 2035 |  | 
|  | 2036 | device_config->vp_config[i].fifo.no_snoop_bits = | 
|  | 2037 | VXGE_HW_FIFO_NO_SNOOP_DEFAULT; | 
|  | 2038 | device_config->vp_config[i].tti.intr_enable = | 
|  | 2039 | VXGE_HW_TIM_INTR_DEFAULT; | 
|  | 2040 |  | 
|  | 2041 | device_config->vp_config[i].tti.btimer_val = | 
|  | 2042 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2043 |  | 
|  | 2044 | device_config->vp_config[i].tti.timer_ac_en = | 
|  | 2045 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2046 |  | 
|  | 2047 | device_config->vp_config[i].tti.timer_ci_en = | 
|  | 2048 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2049 |  | 
|  | 2050 | device_config->vp_config[i].tti.timer_ri_en = | 
|  | 2051 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2052 |  | 
|  | 2053 | device_config->vp_config[i].tti.rtimer_val = | 
|  | 2054 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2055 |  | 
|  | 2056 | device_config->vp_config[i].tti.util_sel = | 
|  | 2057 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2058 |  | 
|  | 2059 | device_config->vp_config[i].tti.ltimer_val = | 
|  | 2060 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2061 |  | 
|  | 2062 | device_config->vp_config[i].tti.urange_a = | 
|  | 2063 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2064 |  | 
|  | 2065 | device_config->vp_config[i].tti.uec_a = | 
|  | 2066 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2067 |  | 
|  | 2068 | device_config->vp_config[i].tti.urange_b = | 
|  | 2069 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2070 |  | 
|  | 2071 | device_config->vp_config[i].tti.uec_b = | 
|  | 2072 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2073 |  | 
|  | 2074 | device_config->vp_config[i].tti.urange_c = | 
|  | 2075 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2076 |  | 
|  | 2077 | device_config->vp_config[i].tti.uec_c = | 
|  | 2078 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2079 |  | 
|  | 2080 | device_config->vp_config[i].tti.uec_d = | 
|  | 2081 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2082 |  | 
|  | 2083 | device_config->vp_config[i].rti.intr_enable = | 
|  | 2084 | VXGE_HW_TIM_INTR_DEFAULT; | 
|  | 2085 |  | 
|  | 2086 | device_config->vp_config[i].rti.btimer_val = | 
|  | 2087 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2088 |  | 
|  | 2089 | device_config->vp_config[i].rti.timer_ac_en = | 
|  | 2090 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2091 |  | 
|  | 2092 | device_config->vp_config[i].rti.timer_ci_en = | 
|  | 2093 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2094 |  | 
|  | 2095 | device_config->vp_config[i].rti.timer_ri_en = | 
|  | 2096 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2097 |  | 
|  | 2098 | device_config->vp_config[i].rti.rtimer_val = | 
|  | 2099 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2100 |  | 
|  | 2101 | device_config->vp_config[i].rti.util_sel = | 
|  | 2102 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2103 |  | 
|  | 2104 | device_config->vp_config[i].rti.ltimer_val = | 
|  | 2105 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2106 |  | 
|  | 2107 | device_config->vp_config[i].rti.urange_a = | 
|  | 2108 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2109 |  | 
|  | 2110 | device_config->vp_config[i].rti.uec_a = | 
|  | 2111 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2112 |  | 
|  | 2113 | device_config->vp_config[i].rti.urange_b = | 
|  | 2114 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2115 |  | 
|  | 2116 | device_config->vp_config[i].rti.uec_b = | 
|  | 2117 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2118 |  | 
|  | 2119 | device_config->vp_config[i].rti.urange_c = | 
|  | 2120 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2121 |  | 
|  | 2122 | device_config->vp_config[i].rti.uec_c = | 
|  | 2123 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2124 |  | 
|  | 2125 | device_config->vp_config[i].rti.uec_d = | 
|  | 2126 | VXGE_HW_USE_FLASH_DEFAULT; | 
|  | 2127 |  | 
|  | 2128 | device_config->vp_config[i].mtu = | 
|  | 2129 | VXGE_HW_VPATH_USE_FLASH_DEFAULT_INITIAL_MTU; | 
|  | 2130 |  | 
|  | 2131 | device_config->vp_config[i].rpa_strip_vlan_tag = | 
|  | 2132 | VXGE_HW_VPATH_RPA_STRIP_VLAN_TAG_USE_FLASH_DEFAULT; | 
|  | 2133 | } | 
|  | 2134 |  | 
|  | 2135 | return VXGE_HW_OK; | 
|  | 2136 | } | 
|  | 2137 |  | 
|  | 2138 | /* | 
|  | 2139 | * _hw_legacy_swapper_set - Set the swapper bits for the legacy secion. | 
|  | 2140 | * Set the swapper bits appropriately for the lagacy section. | 
|  | 2141 | */ | 
|  | 2142 | enum vxge_hw_status | 
|  | 2143 | __vxge_hw_legacy_swapper_set(struct vxge_hw_legacy_reg __iomem *legacy_reg) | 
|  | 2144 | { | 
|  | 2145 | u64 val64; | 
|  | 2146 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 2147 |  | 
|  | 2148 | val64 = readq(&legacy_reg->toc_swapper_fb); | 
|  | 2149 |  | 
|  | 2150 | wmb(); | 
|  | 2151 |  | 
|  | 2152 | switch (val64) { | 
|  | 2153 |  | 
|  | 2154 | case VXGE_HW_SWAPPER_INITIAL_VALUE: | 
|  | 2155 | return status; | 
|  | 2156 |  | 
|  | 2157 | case VXGE_HW_SWAPPER_BYTE_SWAPPED_BIT_FLIPPED: | 
|  | 2158 | writeq(VXGE_HW_SWAPPER_READ_BYTE_SWAP_ENABLE, | 
|  | 2159 | &legacy_reg->pifm_rd_swap_en); | 
|  | 2160 | writeq(VXGE_HW_SWAPPER_READ_BIT_FLAP_ENABLE, | 
|  | 2161 | &legacy_reg->pifm_rd_flip_en); | 
|  | 2162 | writeq(VXGE_HW_SWAPPER_WRITE_BYTE_SWAP_ENABLE, | 
|  | 2163 | &legacy_reg->pifm_wr_swap_en); | 
|  | 2164 | writeq(VXGE_HW_SWAPPER_WRITE_BIT_FLAP_ENABLE, | 
|  | 2165 | &legacy_reg->pifm_wr_flip_en); | 
|  | 2166 | break; | 
|  | 2167 |  | 
|  | 2168 | case VXGE_HW_SWAPPER_BYTE_SWAPPED: | 
|  | 2169 | writeq(VXGE_HW_SWAPPER_READ_BYTE_SWAP_ENABLE, | 
|  | 2170 | &legacy_reg->pifm_rd_swap_en); | 
|  | 2171 | writeq(VXGE_HW_SWAPPER_WRITE_BYTE_SWAP_ENABLE, | 
|  | 2172 | &legacy_reg->pifm_wr_swap_en); | 
|  | 2173 | break; | 
|  | 2174 |  | 
|  | 2175 | case VXGE_HW_SWAPPER_BIT_FLIPPED: | 
|  | 2176 | writeq(VXGE_HW_SWAPPER_READ_BIT_FLAP_ENABLE, | 
|  | 2177 | &legacy_reg->pifm_rd_flip_en); | 
|  | 2178 | writeq(VXGE_HW_SWAPPER_WRITE_BIT_FLAP_ENABLE, | 
|  | 2179 | &legacy_reg->pifm_wr_flip_en); | 
|  | 2180 | break; | 
|  | 2181 | } | 
|  | 2182 |  | 
|  | 2183 | wmb(); | 
|  | 2184 |  | 
|  | 2185 | val64 = readq(&legacy_reg->toc_swapper_fb); | 
|  | 2186 |  | 
|  | 2187 | if (val64 != VXGE_HW_SWAPPER_INITIAL_VALUE) | 
|  | 2188 | status = VXGE_HW_ERR_SWAPPER_CTRL; | 
|  | 2189 |  | 
|  | 2190 | return status; | 
|  | 2191 | } | 
|  | 2192 |  | 
|  | 2193 | /* | 
|  | 2194 | * __vxge_hw_vpath_swapper_set - Set the swapper bits for the vpath. | 
|  | 2195 | * Set the swapper bits appropriately for the vpath. | 
|  | 2196 | */ | 
|  | 2197 | enum vxge_hw_status | 
|  | 2198 | __vxge_hw_vpath_swapper_set(struct vxge_hw_vpath_reg __iomem *vpath_reg) | 
|  | 2199 | { | 
|  | 2200 | #ifndef __BIG_ENDIAN | 
|  | 2201 | u64 val64; | 
|  | 2202 |  | 
|  | 2203 | val64 = readq(&vpath_reg->vpath_general_cfg1); | 
|  | 2204 | wmb(); | 
|  | 2205 | val64 |= VXGE_HW_VPATH_GENERAL_CFG1_CTL_BYTE_SWAPEN; | 
|  | 2206 | writeq(val64, &vpath_reg->vpath_general_cfg1); | 
|  | 2207 | wmb(); | 
|  | 2208 | #endif | 
|  | 2209 | return VXGE_HW_OK; | 
|  | 2210 | } | 
|  | 2211 |  | 
|  | 2212 | /* | 
|  | 2213 | * __vxge_hw_kdfc_swapper_set - Set the swapper bits for the kdfc. | 
|  | 2214 | * Set the swapper bits appropriately for the vpath. | 
|  | 2215 | */ | 
|  | 2216 | enum vxge_hw_status | 
|  | 2217 | __vxge_hw_kdfc_swapper_set( | 
|  | 2218 | struct vxge_hw_legacy_reg __iomem *legacy_reg, | 
|  | 2219 | struct vxge_hw_vpath_reg __iomem *vpath_reg) | 
|  | 2220 | { | 
|  | 2221 | u64 val64; | 
|  | 2222 |  | 
|  | 2223 | val64 = readq(&legacy_reg->pifm_wr_swap_en); | 
|  | 2224 |  | 
|  | 2225 | if (val64 == VXGE_HW_SWAPPER_WRITE_BYTE_SWAP_ENABLE) { | 
|  | 2226 | val64 = readq(&vpath_reg->kdfcctl_cfg0); | 
|  | 2227 | wmb(); | 
|  | 2228 |  | 
|  | 2229 | val64 |= VXGE_HW_KDFCCTL_CFG0_BYTE_SWAPEN_FIFO0	| | 
|  | 2230 | VXGE_HW_KDFCCTL_CFG0_BYTE_SWAPEN_FIFO1	| | 
|  | 2231 | VXGE_HW_KDFCCTL_CFG0_BYTE_SWAPEN_FIFO2; | 
|  | 2232 |  | 
|  | 2233 | writeq(val64, &vpath_reg->kdfcctl_cfg0); | 
|  | 2234 | wmb(); | 
|  | 2235 | } | 
|  | 2236 |  | 
|  | 2237 | return VXGE_HW_OK; | 
|  | 2238 | } | 
|  | 2239 |  | 
|  | 2240 | /* | 
|  | 2241 | * vxge_hw_mgmt_device_config - Retrieve device configuration. | 
|  | 2242 | * Get device configuration. Permits to retrieve at run-time configuration | 
|  | 2243 | * values that were used to initialize and configure the device. | 
|  | 2244 | */ | 
|  | 2245 | enum vxge_hw_status | 
|  | 2246 | vxge_hw_mgmt_device_config(struct __vxge_hw_device *hldev, | 
|  | 2247 | struct vxge_hw_device_config *dev_config, int size) | 
|  | 2248 | { | 
|  | 2249 |  | 
|  | 2250 | if ((hldev == NULL) || (hldev->magic != VXGE_HW_DEVICE_MAGIC)) | 
|  | 2251 | return VXGE_HW_ERR_INVALID_DEVICE; | 
|  | 2252 |  | 
|  | 2253 | if (size != sizeof(struct vxge_hw_device_config)) | 
|  | 2254 | return VXGE_HW_ERR_VERSION_CONFLICT; | 
|  | 2255 |  | 
|  | 2256 | memcpy(dev_config, &hldev->config, | 
|  | 2257 | sizeof(struct vxge_hw_device_config)); | 
|  | 2258 |  | 
|  | 2259 | return VXGE_HW_OK; | 
|  | 2260 | } | 
|  | 2261 |  | 
|  | 2262 | /* | 
|  | 2263 | * vxge_hw_mgmt_reg_read - Read Titan register. | 
|  | 2264 | */ | 
|  | 2265 | enum vxge_hw_status | 
|  | 2266 | vxge_hw_mgmt_reg_read(struct __vxge_hw_device *hldev, | 
|  | 2267 | enum vxge_hw_mgmt_reg_type type, | 
|  | 2268 | u32 index, u32 offset, u64 *value) | 
|  | 2269 | { | 
|  | 2270 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 2271 |  | 
|  | 2272 | if ((hldev == NULL) || (hldev->magic != VXGE_HW_DEVICE_MAGIC)) { | 
|  | 2273 | status = VXGE_HW_ERR_INVALID_DEVICE; | 
|  | 2274 | goto exit; | 
|  | 2275 | } | 
|  | 2276 |  | 
|  | 2277 | switch (type) { | 
|  | 2278 | case vxge_hw_mgmt_reg_type_legacy: | 
|  | 2279 | if (offset > sizeof(struct vxge_hw_legacy_reg) - 8) { | 
|  | 2280 | status = VXGE_HW_ERR_INVALID_OFFSET; | 
|  | 2281 | break; | 
|  | 2282 | } | 
|  | 2283 | *value = readq((void __iomem *)hldev->legacy_reg + offset); | 
|  | 2284 | break; | 
|  | 2285 | case vxge_hw_mgmt_reg_type_toc: | 
|  | 2286 | if (offset > sizeof(struct vxge_hw_toc_reg) - 8) { | 
|  | 2287 | status = VXGE_HW_ERR_INVALID_OFFSET; | 
|  | 2288 | break; | 
|  | 2289 | } | 
|  | 2290 | *value = readq((void __iomem *)hldev->toc_reg + offset); | 
|  | 2291 | break; | 
|  | 2292 | case vxge_hw_mgmt_reg_type_common: | 
|  | 2293 | if (offset > sizeof(struct vxge_hw_common_reg) - 8) { | 
|  | 2294 | status = VXGE_HW_ERR_INVALID_OFFSET; | 
|  | 2295 | break; | 
|  | 2296 | } | 
|  | 2297 | *value = readq((void __iomem *)hldev->common_reg + offset); | 
|  | 2298 | break; | 
|  | 2299 | case vxge_hw_mgmt_reg_type_mrpcim: | 
|  | 2300 | if (!(hldev->access_rights & | 
|  | 2301 | VXGE_HW_DEVICE_ACCESS_RIGHT_MRPCIM)) { | 
|  | 2302 | status = VXGE_HW_ERR_PRIVILAGED_OPEARATION; | 
|  | 2303 | break; | 
|  | 2304 | } | 
|  | 2305 | if (offset > sizeof(struct vxge_hw_mrpcim_reg) - 8) { | 
|  | 2306 | status = VXGE_HW_ERR_INVALID_OFFSET; | 
|  | 2307 | break; | 
|  | 2308 | } | 
|  | 2309 | *value = readq((void __iomem *)hldev->mrpcim_reg + offset); | 
|  | 2310 | break; | 
|  | 2311 | case vxge_hw_mgmt_reg_type_srpcim: | 
|  | 2312 | if (!(hldev->access_rights & | 
|  | 2313 | VXGE_HW_DEVICE_ACCESS_RIGHT_SRPCIM)) { | 
|  | 2314 | status = VXGE_HW_ERR_PRIVILAGED_OPEARATION; | 
|  | 2315 | break; | 
|  | 2316 | } | 
|  | 2317 | if (index > VXGE_HW_TITAN_SRPCIM_REG_SPACES - 1) { | 
|  | 2318 | status = VXGE_HW_ERR_INVALID_INDEX; | 
|  | 2319 | break; | 
|  | 2320 | } | 
|  | 2321 | if (offset > sizeof(struct vxge_hw_srpcim_reg) - 8) { | 
|  | 2322 | status = VXGE_HW_ERR_INVALID_OFFSET; | 
|  | 2323 | break; | 
|  | 2324 | } | 
|  | 2325 | *value = readq((void __iomem *)hldev->srpcim_reg[index] + | 
|  | 2326 | offset); | 
|  | 2327 | break; | 
|  | 2328 | case vxge_hw_mgmt_reg_type_vpmgmt: | 
|  | 2329 | if ((index > VXGE_HW_TITAN_VPMGMT_REG_SPACES - 1) || | 
|  | 2330 | (!(hldev->vpath_assignments & vxge_mBIT(index)))) { | 
|  | 2331 | status = VXGE_HW_ERR_INVALID_INDEX; | 
|  | 2332 | break; | 
|  | 2333 | } | 
|  | 2334 | if (offset > sizeof(struct vxge_hw_vpmgmt_reg) - 8) { | 
|  | 2335 | status = VXGE_HW_ERR_INVALID_OFFSET; | 
|  | 2336 | break; | 
|  | 2337 | } | 
|  | 2338 | *value = readq((void __iomem *)hldev->vpmgmt_reg[index] + | 
|  | 2339 | offset); | 
|  | 2340 | break; | 
|  | 2341 | case vxge_hw_mgmt_reg_type_vpath: | 
|  | 2342 | if ((index > VXGE_HW_TITAN_VPATH_REG_SPACES - 1) || | 
|  | 2343 | (!(hldev->vpath_assignments & vxge_mBIT(index)))) { | 
|  | 2344 | status = VXGE_HW_ERR_INVALID_INDEX; | 
|  | 2345 | break; | 
|  | 2346 | } | 
|  | 2347 | if (index > VXGE_HW_TITAN_VPATH_REG_SPACES - 1) { | 
|  | 2348 | status = VXGE_HW_ERR_INVALID_INDEX; | 
|  | 2349 | break; | 
|  | 2350 | } | 
|  | 2351 | if (offset > sizeof(struct vxge_hw_vpath_reg) - 8) { | 
|  | 2352 | status = VXGE_HW_ERR_INVALID_OFFSET; | 
|  | 2353 | break; | 
|  | 2354 | } | 
|  | 2355 | *value = readq((void __iomem *)hldev->vpath_reg[index] + | 
|  | 2356 | offset); | 
|  | 2357 | break; | 
|  | 2358 | default: | 
|  | 2359 | status = VXGE_HW_ERR_INVALID_TYPE; | 
|  | 2360 | break; | 
|  | 2361 | } | 
|  | 2362 |  | 
|  | 2363 | exit: | 
|  | 2364 | return status; | 
|  | 2365 | } | 
|  | 2366 |  | 
|  | 2367 | /* | 
|  | 2368 | * vxge_hw_mgmt_reg_Write - Write Titan register. | 
|  | 2369 | */ | 
|  | 2370 | enum vxge_hw_status | 
|  | 2371 | vxge_hw_mgmt_reg_write(struct __vxge_hw_device *hldev, | 
|  | 2372 | enum vxge_hw_mgmt_reg_type type, | 
|  | 2373 | u32 index, u32 offset, u64 value) | 
|  | 2374 | { | 
|  | 2375 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 2376 |  | 
|  | 2377 | if ((hldev == NULL) || (hldev->magic != VXGE_HW_DEVICE_MAGIC)) { | 
|  | 2378 | status = VXGE_HW_ERR_INVALID_DEVICE; | 
|  | 2379 | goto exit; | 
|  | 2380 | } | 
|  | 2381 |  | 
|  | 2382 | switch (type) { | 
|  | 2383 | case vxge_hw_mgmt_reg_type_legacy: | 
|  | 2384 | if (offset > sizeof(struct vxge_hw_legacy_reg) - 8) { | 
|  | 2385 | status = VXGE_HW_ERR_INVALID_OFFSET; | 
|  | 2386 | break; | 
|  | 2387 | } | 
|  | 2388 | writeq(value, (void __iomem *)hldev->legacy_reg + offset); | 
|  | 2389 | break; | 
|  | 2390 | case vxge_hw_mgmt_reg_type_toc: | 
|  | 2391 | if (offset > sizeof(struct vxge_hw_toc_reg) - 8) { | 
|  | 2392 | status = VXGE_HW_ERR_INVALID_OFFSET; | 
|  | 2393 | break; | 
|  | 2394 | } | 
|  | 2395 | writeq(value, (void __iomem *)hldev->toc_reg + offset); | 
|  | 2396 | break; | 
|  | 2397 | case vxge_hw_mgmt_reg_type_common: | 
|  | 2398 | if (offset > sizeof(struct vxge_hw_common_reg) - 8) { | 
|  | 2399 | status = VXGE_HW_ERR_INVALID_OFFSET; | 
|  | 2400 | break; | 
|  | 2401 | } | 
|  | 2402 | writeq(value, (void __iomem *)hldev->common_reg + offset); | 
|  | 2403 | break; | 
|  | 2404 | case vxge_hw_mgmt_reg_type_mrpcim: | 
|  | 2405 | if (!(hldev->access_rights & | 
|  | 2406 | VXGE_HW_DEVICE_ACCESS_RIGHT_MRPCIM)) { | 
|  | 2407 | status = VXGE_HW_ERR_PRIVILAGED_OPEARATION; | 
|  | 2408 | break; | 
|  | 2409 | } | 
|  | 2410 | if (offset > sizeof(struct vxge_hw_mrpcim_reg) - 8) { | 
|  | 2411 | status = VXGE_HW_ERR_INVALID_OFFSET; | 
|  | 2412 | break; | 
|  | 2413 | } | 
|  | 2414 | writeq(value, (void __iomem *)hldev->mrpcim_reg + offset); | 
|  | 2415 | break; | 
|  | 2416 | case vxge_hw_mgmt_reg_type_srpcim: | 
|  | 2417 | if (!(hldev->access_rights & | 
|  | 2418 | VXGE_HW_DEVICE_ACCESS_RIGHT_SRPCIM)) { | 
|  | 2419 | status = VXGE_HW_ERR_PRIVILAGED_OPEARATION; | 
|  | 2420 | break; | 
|  | 2421 | } | 
|  | 2422 | if (index > VXGE_HW_TITAN_SRPCIM_REG_SPACES - 1) { | 
|  | 2423 | status = VXGE_HW_ERR_INVALID_INDEX; | 
|  | 2424 | break; | 
|  | 2425 | } | 
|  | 2426 | if (offset > sizeof(struct vxge_hw_srpcim_reg) - 8) { | 
|  | 2427 | status = VXGE_HW_ERR_INVALID_OFFSET; | 
|  | 2428 | break; | 
|  | 2429 | } | 
|  | 2430 | writeq(value, (void __iomem *)hldev->srpcim_reg[index] + | 
|  | 2431 | offset); | 
|  | 2432 |  | 
|  | 2433 | break; | 
|  | 2434 | case vxge_hw_mgmt_reg_type_vpmgmt: | 
|  | 2435 | if ((index > VXGE_HW_TITAN_VPMGMT_REG_SPACES - 1) || | 
|  | 2436 | (!(hldev->vpath_assignments & vxge_mBIT(index)))) { | 
|  | 2437 | status = VXGE_HW_ERR_INVALID_INDEX; | 
|  | 2438 | break; | 
|  | 2439 | } | 
|  | 2440 | if (offset > sizeof(struct vxge_hw_vpmgmt_reg) - 8) { | 
|  | 2441 | status = VXGE_HW_ERR_INVALID_OFFSET; | 
|  | 2442 | break; | 
|  | 2443 | } | 
|  | 2444 | writeq(value, (void __iomem *)hldev->vpmgmt_reg[index] + | 
|  | 2445 | offset); | 
|  | 2446 | break; | 
|  | 2447 | case vxge_hw_mgmt_reg_type_vpath: | 
|  | 2448 | if ((index > VXGE_HW_TITAN_VPATH_REG_SPACES-1) || | 
|  | 2449 | (!(hldev->vpath_assignments & vxge_mBIT(index)))) { | 
|  | 2450 | status = VXGE_HW_ERR_INVALID_INDEX; | 
|  | 2451 | break; | 
|  | 2452 | } | 
|  | 2453 | if (offset > sizeof(struct vxge_hw_vpath_reg) - 8) { | 
|  | 2454 | status = VXGE_HW_ERR_INVALID_OFFSET; | 
|  | 2455 | break; | 
|  | 2456 | } | 
|  | 2457 | writeq(value, (void __iomem *)hldev->vpath_reg[index] + | 
|  | 2458 | offset); | 
|  | 2459 | break; | 
|  | 2460 | default: | 
|  | 2461 | status = VXGE_HW_ERR_INVALID_TYPE; | 
|  | 2462 | break; | 
|  | 2463 | } | 
|  | 2464 | exit: | 
|  | 2465 | return status; | 
|  | 2466 | } | 
|  | 2467 |  | 
|  | 2468 | /* | 
|  | 2469 | * __vxge_hw_fifo_mempool_item_alloc - Allocate List blocks for TxD | 
|  | 2470 | * list callback | 
|  | 2471 | * This function is callback passed to __vxge_hw_mempool_create to create memory | 
|  | 2472 | * pool for TxD list | 
|  | 2473 | */ | 
|  | 2474 | static void | 
|  | 2475 | __vxge_hw_fifo_mempool_item_alloc( | 
|  | 2476 | struct vxge_hw_mempool *mempoolh, | 
|  | 2477 | u32 memblock_index, struct vxge_hw_mempool_dma *dma_object, | 
|  | 2478 | u32 index, u32 is_last) | 
|  | 2479 | { | 
|  | 2480 | u32 memblock_item_idx; | 
|  | 2481 | struct __vxge_hw_fifo_txdl_priv *txdl_priv; | 
|  | 2482 | struct vxge_hw_fifo_txd *txdp = | 
|  | 2483 | (struct vxge_hw_fifo_txd *)mempoolh->items_arr[index]; | 
|  | 2484 | struct __vxge_hw_fifo *fifo = | 
|  | 2485 | (struct __vxge_hw_fifo *)mempoolh->userdata; | 
|  | 2486 | void *memblock = mempoolh->memblocks_arr[memblock_index]; | 
|  | 2487 |  | 
|  | 2488 | vxge_assert(txdp); | 
|  | 2489 |  | 
|  | 2490 | txdp->host_control = (u64) (size_t) | 
|  | 2491 | __vxge_hw_mempool_item_priv(mempoolh, memblock_index, txdp, | 
|  | 2492 | &memblock_item_idx); | 
|  | 2493 |  | 
|  | 2494 | txdl_priv = __vxge_hw_fifo_txdl_priv(fifo, txdp); | 
|  | 2495 |  | 
|  | 2496 | vxge_assert(txdl_priv); | 
|  | 2497 |  | 
|  | 2498 | fifo->channel.reserve_arr[fifo->channel.reserve_ptr - 1 - index] = txdp; | 
|  | 2499 |  | 
|  | 2500 | /* pre-format HW's TxDL's private */ | 
|  | 2501 | txdl_priv->dma_offset = (char *)txdp - (char *)memblock; | 
|  | 2502 | txdl_priv->dma_addr = dma_object->addr + txdl_priv->dma_offset; | 
|  | 2503 | txdl_priv->dma_handle = dma_object->handle; | 
|  | 2504 | txdl_priv->memblock   = memblock; | 
|  | 2505 | txdl_priv->first_txdp = txdp; | 
|  | 2506 | txdl_priv->next_txdl_priv = NULL; | 
|  | 2507 | txdl_priv->alloc_frags = 0; | 
|  | 2508 |  | 
|  | 2509 | return; | 
|  | 2510 | } | 
|  | 2511 |  | 
|  | 2512 | /* | 
|  | 2513 | * __vxge_hw_fifo_create - Create a FIFO | 
|  | 2514 | * This function creates FIFO and initializes it. | 
|  | 2515 | */ | 
|  | 2516 | enum vxge_hw_status | 
|  | 2517 | __vxge_hw_fifo_create(struct __vxge_hw_vpath_handle *vp, | 
|  | 2518 | struct vxge_hw_fifo_attr *attr) | 
|  | 2519 | { | 
|  | 2520 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 2521 | struct __vxge_hw_fifo *fifo; | 
|  | 2522 | struct vxge_hw_fifo_config *config; | 
|  | 2523 | u32 txdl_size, txdl_per_memblock; | 
|  | 2524 | struct vxge_hw_mempool_cbs fifo_mp_callback; | 
|  | 2525 | struct __vxge_hw_virtualpath *vpath; | 
|  | 2526 |  | 
|  | 2527 | if ((vp == NULL) || (attr == NULL)) { | 
|  | 2528 | status = VXGE_HW_ERR_INVALID_HANDLE; | 
|  | 2529 | goto exit; | 
|  | 2530 | } | 
|  | 2531 | vpath = vp->vpath; | 
|  | 2532 | config = &vpath->hldev->config.vp_config[vpath->vp_id].fifo; | 
|  | 2533 |  | 
|  | 2534 | txdl_size = config->max_frags * sizeof(struct vxge_hw_fifo_txd); | 
|  | 2535 |  | 
|  | 2536 | txdl_per_memblock = config->memblock_size / txdl_size; | 
|  | 2537 |  | 
|  | 2538 | fifo = (struct __vxge_hw_fifo *)__vxge_hw_channel_allocate(vp, | 
|  | 2539 | VXGE_HW_CHANNEL_TYPE_FIFO, | 
|  | 2540 | config->fifo_blocks * txdl_per_memblock, | 
|  | 2541 | attr->per_txdl_space, attr->userdata); | 
|  | 2542 |  | 
|  | 2543 | if (fifo == NULL) { | 
|  | 2544 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 2545 | goto exit; | 
|  | 2546 | } | 
|  | 2547 |  | 
|  | 2548 | vpath->fifoh = fifo; | 
|  | 2549 | fifo->nofl_db = vpath->nofl_db; | 
|  | 2550 |  | 
|  | 2551 | fifo->vp_id = vpath->vp_id; | 
|  | 2552 | fifo->vp_reg = vpath->vp_reg; | 
|  | 2553 | fifo->stats = &vpath->sw_stats->fifo_stats; | 
|  | 2554 |  | 
|  | 2555 | fifo->config = config; | 
|  | 2556 |  | 
|  | 2557 | /* apply "interrupts per txdl" attribute */ | 
|  | 2558 | fifo->interrupt_type = VXGE_HW_FIFO_TXD_INT_TYPE_UTILZ; | 
|  | 2559 |  | 
|  | 2560 | if (fifo->config->intr) | 
|  | 2561 | fifo->interrupt_type = VXGE_HW_FIFO_TXD_INT_TYPE_PER_LIST; | 
|  | 2562 |  | 
|  | 2563 | fifo->no_snoop_bits = config->no_snoop_bits; | 
|  | 2564 |  | 
|  | 2565 | /* | 
|  | 2566 | * FIFO memory management strategy: | 
|  | 2567 | * | 
|  | 2568 | * TxDL split into three independent parts: | 
|  | 2569 | *	- set of TxD's | 
|  | 2570 | *	- TxD HW private part | 
|  | 2571 | *	- driver private part | 
|  | 2572 | * | 
|  | 2573 | * Adaptative memory allocation used. i.e. Memory allocated on | 
|  | 2574 | * demand with the size which will fit into one memory block. | 
|  | 2575 | * One memory block may contain more than one TxDL. | 
|  | 2576 | * | 
|  | 2577 | * During "reserve" operations more memory can be allocated on demand | 
|  | 2578 | * for example due to FIFO full condition. | 
|  | 2579 | * | 
|  | 2580 | * Pool of memory memblocks never shrinks except in __vxge_hw_fifo_close | 
|  | 2581 | * routine which will essentially stop the channel and free resources. | 
|  | 2582 | */ | 
|  | 2583 |  | 
|  | 2584 | /* TxDL common private size == TxDL private  +  driver private */ | 
|  | 2585 | fifo->priv_size = | 
|  | 2586 | sizeof(struct __vxge_hw_fifo_txdl_priv) + attr->per_txdl_space; | 
|  | 2587 | fifo->priv_size = ((fifo->priv_size  +  VXGE_CACHE_LINE_SIZE - 1) / | 
|  | 2588 | VXGE_CACHE_LINE_SIZE) * VXGE_CACHE_LINE_SIZE; | 
|  | 2589 |  | 
|  | 2590 | fifo->per_txdl_space = attr->per_txdl_space; | 
|  | 2591 |  | 
|  | 2592 | /* recompute txdl size to be cacheline aligned */ | 
|  | 2593 | fifo->txdl_size = txdl_size; | 
|  | 2594 | fifo->txdl_per_memblock = txdl_per_memblock; | 
|  | 2595 |  | 
|  | 2596 | fifo->txdl_term = attr->txdl_term; | 
|  | 2597 | fifo->callback = attr->callback; | 
|  | 2598 |  | 
|  | 2599 | if (fifo->txdl_per_memblock == 0) { | 
|  | 2600 | __vxge_hw_fifo_delete(vp); | 
|  | 2601 | status = VXGE_HW_ERR_INVALID_BLOCK_SIZE; | 
|  | 2602 | goto exit; | 
|  | 2603 | } | 
|  | 2604 |  | 
|  | 2605 | fifo_mp_callback.item_func_alloc = __vxge_hw_fifo_mempool_item_alloc; | 
|  | 2606 |  | 
|  | 2607 | fifo->mempool = | 
|  | 2608 | __vxge_hw_mempool_create(vpath->hldev, | 
|  | 2609 | fifo->config->memblock_size, | 
|  | 2610 | fifo->txdl_size, | 
|  | 2611 | fifo->priv_size, | 
|  | 2612 | (fifo->config->fifo_blocks * fifo->txdl_per_memblock), | 
|  | 2613 | (fifo->config->fifo_blocks * fifo->txdl_per_memblock), | 
|  | 2614 | &fifo_mp_callback, | 
|  | 2615 | fifo); | 
|  | 2616 |  | 
|  | 2617 | if (fifo->mempool == NULL) { | 
|  | 2618 | __vxge_hw_fifo_delete(vp); | 
|  | 2619 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 2620 | goto exit; | 
|  | 2621 | } | 
|  | 2622 |  | 
|  | 2623 | status = __vxge_hw_channel_initialize(&fifo->channel); | 
|  | 2624 | if (status != VXGE_HW_OK) { | 
|  | 2625 | __vxge_hw_fifo_delete(vp); | 
|  | 2626 | goto exit; | 
|  | 2627 | } | 
|  | 2628 |  | 
|  | 2629 | vxge_assert(fifo->channel.reserve_ptr); | 
|  | 2630 | exit: | 
|  | 2631 | return status; | 
|  | 2632 | } | 
|  | 2633 |  | 
|  | 2634 | /* | 
|  | 2635 | * __vxge_hw_fifo_abort - Returns the TxD | 
|  | 2636 | * This function terminates the TxDs of fifo | 
|  | 2637 | */ | 
|  | 2638 | enum vxge_hw_status __vxge_hw_fifo_abort(struct __vxge_hw_fifo *fifo) | 
|  | 2639 | { | 
|  | 2640 | void *txdlh; | 
|  | 2641 |  | 
|  | 2642 | for (;;) { | 
|  | 2643 | vxge_hw_channel_dtr_try_complete(&fifo->channel, &txdlh); | 
|  | 2644 |  | 
|  | 2645 | if (txdlh == NULL) | 
|  | 2646 | break; | 
|  | 2647 |  | 
|  | 2648 | vxge_hw_channel_dtr_complete(&fifo->channel); | 
|  | 2649 |  | 
|  | 2650 | if (fifo->txdl_term) { | 
|  | 2651 | fifo->txdl_term(txdlh, | 
|  | 2652 | VXGE_HW_TXDL_STATE_POSTED, | 
|  | 2653 | fifo->channel.userdata); | 
|  | 2654 | } | 
|  | 2655 |  | 
|  | 2656 | vxge_hw_channel_dtr_free(&fifo->channel, txdlh); | 
|  | 2657 | } | 
|  | 2658 |  | 
|  | 2659 | return VXGE_HW_OK; | 
|  | 2660 | } | 
|  | 2661 |  | 
|  | 2662 | /* | 
|  | 2663 | * __vxge_hw_fifo_reset - Resets the fifo | 
|  | 2664 | * This function resets the fifo during vpath reset operation | 
|  | 2665 | */ | 
|  | 2666 | enum vxge_hw_status __vxge_hw_fifo_reset(struct __vxge_hw_fifo *fifo) | 
|  | 2667 | { | 
|  | 2668 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 2669 |  | 
|  | 2670 | __vxge_hw_fifo_abort(fifo); | 
|  | 2671 | status = __vxge_hw_channel_reset(&fifo->channel); | 
|  | 2672 |  | 
|  | 2673 | return status; | 
|  | 2674 | } | 
|  | 2675 |  | 
|  | 2676 | /* | 
|  | 2677 | * __vxge_hw_fifo_delete - Removes the FIFO | 
|  | 2678 | * This function freeup the memory pool and removes the FIFO | 
|  | 2679 | */ | 
|  | 2680 | enum vxge_hw_status __vxge_hw_fifo_delete(struct __vxge_hw_vpath_handle *vp) | 
|  | 2681 | { | 
|  | 2682 | struct __vxge_hw_fifo *fifo = vp->vpath->fifoh; | 
|  | 2683 |  | 
|  | 2684 | __vxge_hw_fifo_abort(fifo); | 
|  | 2685 |  | 
|  | 2686 | if (fifo->mempool) | 
|  | 2687 | __vxge_hw_mempool_destroy(fifo->mempool); | 
|  | 2688 |  | 
|  | 2689 | vp->vpath->fifoh = NULL; | 
|  | 2690 |  | 
|  | 2691 | __vxge_hw_channel_free(&fifo->channel); | 
|  | 2692 |  | 
|  | 2693 | return VXGE_HW_OK; | 
|  | 2694 | } | 
|  | 2695 |  | 
|  | 2696 | /* | 
|  | 2697 | * __vxge_hw_vpath_pci_read - Read the content of given address | 
|  | 2698 | *                          in pci config space. | 
|  | 2699 | * Read from the vpath pci config space. | 
|  | 2700 | */ | 
|  | 2701 | enum vxge_hw_status | 
|  | 2702 | __vxge_hw_vpath_pci_read(struct __vxge_hw_virtualpath *vpath, | 
|  | 2703 | u32 phy_func_0, u32 offset, u32 *val) | 
|  | 2704 | { | 
|  | 2705 | u64 val64; | 
|  | 2706 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 2707 | struct vxge_hw_vpath_reg __iomem *vp_reg = vpath->vp_reg; | 
|  | 2708 |  | 
|  | 2709 | val64 =	VXGE_HW_PCI_CONFIG_ACCESS_CFG1_ADDRESS(offset); | 
|  | 2710 |  | 
|  | 2711 | if (phy_func_0) | 
|  | 2712 | val64 |= VXGE_HW_PCI_CONFIG_ACCESS_CFG1_SEL_FUNC0; | 
|  | 2713 |  | 
|  | 2714 | writeq(val64, &vp_reg->pci_config_access_cfg1); | 
|  | 2715 | wmb(); | 
|  | 2716 | writeq(VXGE_HW_PCI_CONFIG_ACCESS_CFG2_REQ, | 
|  | 2717 | &vp_reg->pci_config_access_cfg2); | 
|  | 2718 | wmb(); | 
|  | 2719 |  | 
|  | 2720 | status = __vxge_hw_device_register_poll( | 
|  | 2721 | &vp_reg->pci_config_access_cfg2, | 
|  | 2722 | VXGE_HW_INTR_MASK_ALL, VXGE_HW_DEF_DEVICE_POLL_MILLIS); | 
|  | 2723 |  | 
|  | 2724 | if (status != VXGE_HW_OK) | 
|  | 2725 | goto exit; | 
|  | 2726 |  | 
|  | 2727 | val64 = readq(&vp_reg->pci_config_access_status); | 
|  | 2728 |  | 
|  | 2729 | if (val64 & VXGE_HW_PCI_CONFIG_ACCESS_STATUS_ACCESS_ERR) { | 
|  | 2730 | status = VXGE_HW_FAIL; | 
|  | 2731 | *val = 0; | 
|  | 2732 | } else | 
|  | 2733 | *val = (u32)vxge_bVALn(val64, 32, 32); | 
|  | 2734 | exit: | 
|  | 2735 | return status; | 
|  | 2736 | } | 
|  | 2737 |  | 
|  | 2738 | /* | 
|  | 2739 | * __vxge_hw_vpath_func_id_get - Get the function id of the vpath. | 
|  | 2740 | * Returns the function number of the vpath. | 
|  | 2741 | */ | 
|  | 2742 | u32 | 
|  | 2743 | __vxge_hw_vpath_func_id_get(u32 vp_id, | 
|  | 2744 | struct vxge_hw_vpmgmt_reg __iomem *vpmgmt_reg) | 
|  | 2745 | { | 
|  | 2746 | u64 val64; | 
|  | 2747 |  | 
|  | 2748 | val64 = readq(&vpmgmt_reg->vpath_to_func_map_cfg1); | 
|  | 2749 |  | 
|  | 2750 | return | 
|  | 2751 | (u32)VXGE_HW_VPATH_TO_FUNC_MAP_CFG1_GET_VPATH_TO_FUNC_MAP_CFG1(val64); | 
|  | 2752 | } | 
|  | 2753 |  | 
|  | 2754 | /* | 
|  | 2755 | * __vxge_hw_read_rts_ds - Program RTS steering critieria | 
|  | 2756 | */ | 
|  | 2757 | static inline void | 
|  | 2758 | __vxge_hw_read_rts_ds(struct vxge_hw_vpath_reg __iomem *vpath_reg, | 
|  | 2759 | u64 dta_struct_sel) | 
|  | 2760 | { | 
|  | 2761 | writeq(0, &vpath_reg->rts_access_steer_ctrl); | 
|  | 2762 | wmb(); | 
|  | 2763 | writeq(dta_struct_sel, &vpath_reg->rts_access_steer_data0); | 
|  | 2764 | writeq(0, &vpath_reg->rts_access_steer_data1); | 
|  | 2765 | wmb(); | 
|  | 2766 | return; | 
|  | 2767 | } | 
|  | 2768 |  | 
|  | 2769 |  | 
|  | 2770 | /* | 
|  | 2771 | * __vxge_hw_vpath_card_info_get - Get the serial numbers, | 
|  | 2772 | * part number and product description. | 
|  | 2773 | */ | 
|  | 2774 | enum vxge_hw_status | 
|  | 2775 | __vxge_hw_vpath_card_info_get( | 
|  | 2776 | u32 vp_id, | 
|  | 2777 | struct vxge_hw_vpath_reg __iomem *vpath_reg, | 
|  | 2778 | struct vxge_hw_device_hw_info *hw_info) | 
|  | 2779 | { | 
|  | 2780 | u32 i, j; | 
|  | 2781 | u64 val64; | 
|  | 2782 | u64 data1 = 0ULL; | 
|  | 2783 | u64 data2 = 0ULL; | 
|  | 2784 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 2785 | u8 *serial_number = hw_info->serial_number; | 
|  | 2786 | u8 *part_number = hw_info->part_number; | 
|  | 2787 | u8 *product_desc = hw_info->product_desc; | 
|  | 2788 |  | 
|  | 2789 | __vxge_hw_read_rts_ds(vpath_reg, | 
|  | 2790 | VXGE_HW_RTS_ACCESS_STEER_DATA0_MEMO_ITEM_SERIAL_NUMBER); | 
|  | 2791 |  | 
|  | 2792 | val64 = VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION( | 
|  | 2793 | VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION_READ_MEMO_ENTRY) | | 
|  | 2794 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL( | 
|  | 2795 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL_FW_MEMO) | | 
|  | 2796 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE | | 
|  | 2797 | VXGE_HW_RTS_ACCESS_STEER_CTRL_OFFSET(0); | 
|  | 2798 |  | 
|  | 2799 | status = __vxge_hw_pio_mem_write64(val64, | 
|  | 2800 | &vpath_reg->rts_access_steer_ctrl, | 
|  | 2801 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE, | 
|  | 2802 | VXGE_HW_DEF_DEVICE_POLL_MILLIS); | 
|  | 2803 |  | 
|  | 2804 | if (status != VXGE_HW_OK) | 
|  | 2805 | return status; | 
|  | 2806 |  | 
|  | 2807 | val64 = readq(&vpath_reg->rts_access_steer_ctrl); | 
|  | 2808 |  | 
|  | 2809 | if (val64 & VXGE_HW_RTS_ACCESS_STEER_CTRL_RMACJ_STATUS) { | 
|  | 2810 | data1 = readq(&vpath_reg->rts_access_steer_data0); | 
|  | 2811 | ((u64 *)serial_number)[0] = be64_to_cpu(data1); | 
|  | 2812 |  | 
|  | 2813 | data2 = readq(&vpath_reg->rts_access_steer_data1); | 
|  | 2814 | ((u64 *)serial_number)[1] = be64_to_cpu(data2); | 
|  | 2815 | status = VXGE_HW_OK; | 
|  | 2816 | } else | 
|  | 2817 | *serial_number = 0; | 
|  | 2818 |  | 
|  | 2819 | __vxge_hw_read_rts_ds(vpath_reg, | 
|  | 2820 | VXGE_HW_RTS_ACCESS_STEER_DATA0_MEMO_ITEM_PART_NUMBER); | 
|  | 2821 |  | 
|  | 2822 | val64 = VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION( | 
|  | 2823 | VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION_READ_MEMO_ENTRY) | | 
|  | 2824 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL( | 
|  | 2825 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL_FW_MEMO) | | 
|  | 2826 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE | | 
|  | 2827 | VXGE_HW_RTS_ACCESS_STEER_CTRL_OFFSET(0); | 
|  | 2828 |  | 
|  | 2829 | status = __vxge_hw_pio_mem_write64(val64, | 
|  | 2830 | &vpath_reg->rts_access_steer_ctrl, | 
|  | 2831 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE, | 
|  | 2832 | VXGE_HW_DEF_DEVICE_POLL_MILLIS); | 
|  | 2833 |  | 
|  | 2834 | if (status != VXGE_HW_OK) | 
|  | 2835 | return status; | 
|  | 2836 |  | 
|  | 2837 | val64 = readq(&vpath_reg->rts_access_steer_ctrl); | 
|  | 2838 |  | 
|  | 2839 | if (val64 & VXGE_HW_RTS_ACCESS_STEER_CTRL_RMACJ_STATUS) { | 
|  | 2840 |  | 
|  | 2841 | data1 = readq(&vpath_reg->rts_access_steer_data0); | 
|  | 2842 | ((u64 *)part_number)[0] = be64_to_cpu(data1); | 
|  | 2843 |  | 
|  | 2844 | data2 = readq(&vpath_reg->rts_access_steer_data1); | 
|  | 2845 | ((u64 *)part_number)[1] = be64_to_cpu(data2); | 
|  | 2846 |  | 
|  | 2847 | status = VXGE_HW_OK; | 
|  | 2848 |  | 
|  | 2849 | } else | 
|  | 2850 | *part_number = 0; | 
|  | 2851 |  | 
|  | 2852 | j = 0; | 
|  | 2853 |  | 
|  | 2854 | for (i = VXGE_HW_RTS_ACCESS_STEER_DATA0_MEMO_ITEM_DESC_0; | 
|  | 2855 | i <= VXGE_HW_RTS_ACCESS_STEER_DATA0_MEMO_ITEM_DESC_3; i++) { | 
|  | 2856 |  | 
|  | 2857 | __vxge_hw_read_rts_ds(vpath_reg, i); | 
|  | 2858 |  | 
|  | 2859 | val64 = VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION( | 
|  | 2860 | VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION_READ_MEMO_ENTRY) | | 
|  | 2861 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL( | 
|  | 2862 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL_FW_MEMO) | | 
|  | 2863 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE | | 
|  | 2864 | VXGE_HW_RTS_ACCESS_STEER_CTRL_OFFSET(0); | 
|  | 2865 |  | 
|  | 2866 | status = __vxge_hw_pio_mem_write64(val64, | 
|  | 2867 | &vpath_reg->rts_access_steer_ctrl, | 
|  | 2868 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE, | 
|  | 2869 | VXGE_HW_DEF_DEVICE_POLL_MILLIS); | 
|  | 2870 |  | 
|  | 2871 | if (status != VXGE_HW_OK) | 
|  | 2872 | return status; | 
|  | 2873 |  | 
|  | 2874 | val64 = readq(&vpath_reg->rts_access_steer_ctrl); | 
|  | 2875 |  | 
|  | 2876 | if (val64 & VXGE_HW_RTS_ACCESS_STEER_CTRL_RMACJ_STATUS) { | 
|  | 2877 |  | 
|  | 2878 | data1 = readq(&vpath_reg->rts_access_steer_data0); | 
|  | 2879 | ((u64 *)product_desc)[j++] = be64_to_cpu(data1); | 
|  | 2880 |  | 
|  | 2881 | data2 = readq(&vpath_reg->rts_access_steer_data1); | 
|  | 2882 | ((u64 *)product_desc)[j++] = be64_to_cpu(data2); | 
|  | 2883 |  | 
|  | 2884 | status = VXGE_HW_OK; | 
|  | 2885 | } else | 
|  | 2886 | *product_desc = 0; | 
|  | 2887 | } | 
|  | 2888 |  | 
|  | 2889 | return status; | 
|  | 2890 | } | 
|  | 2891 |  | 
|  | 2892 | /* | 
|  | 2893 | * __vxge_hw_vpath_fw_ver_get - Get the fw version | 
|  | 2894 | * Returns FW Version | 
|  | 2895 | */ | 
|  | 2896 | enum vxge_hw_status | 
|  | 2897 | __vxge_hw_vpath_fw_ver_get( | 
|  | 2898 | u32 vp_id, | 
|  | 2899 | struct vxge_hw_vpath_reg __iomem *vpath_reg, | 
|  | 2900 | struct vxge_hw_device_hw_info *hw_info) | 
|  | 2901 | { | 
|  | 2902 | u64 val64; | 
|  | 2903 | u64 data1 = 0ULL; | 
|  | 2904 | u64 data2 = 0ULL; | 
|  | 2905 | struct vxge_hw_device_version *fw_version = &hw_info->fw_version; | 
|  | 2906 | struct vxge_hw_device_date *fw_date = &hw_info->fw_date; | 
|  | 2907 | struct vxge_hw_device_version *flash_version = &hw_info->flash_version; | 
|  | 2908 | struct vxge_hw_device_date *flash_date = &hw_info->flash_date; | 
|  | 2909 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 2910 |  | 
|  | 2911 | val64 = VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION( | 
|  | 2912 | VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION_READ_ENTRY) | | 
|  | 2913 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL( | 
|  | 2914 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL_FW_MEMO) | | 
|  | 2915 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE | | 
|  | 2916 | VXGE_HW_RTS_ACCESS_STEER_CTRL_OFFSET(0); | 
|  | 2917 |  | 
|  | 2918 | status = __vxge_hw_pio_mem_write64(val64, | 
|  | 2919 | &vpath_reg->rts_access_steer_ctrl, | 
|  | 2920 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE, | 
|  | 2921 | VXGE_HW_DEF_DEVICE_POLL_MILLIS); | 
|  | 2922 |  | 
|  | 2923 | if (status != VXGE_HW_OK) | 
|  | 2924 | goto exit; | 
|  | 2925 |  | 
|  | 2926 | val64 = readq(&vpath_reg->rts_access_steer_ctrl); | 
|  | 2927 |  | 
|  | 2928 | if (val64 & VXGE_HW_RTS_ACCESS_STEER_CTRL_RMACJ_STATUS) { | 
|  | 2929 |  | 
|  | 2930 | data1 = readq(&vpath_reg->rts_access_steer_data0); | 
|  | 2931 | data2 = readq(&vpath_reg->rts_access_steer_data1); | 
|  | 2932 |  | 
|  | 2933 | fw_date->day = | 
|  | 2934 | (u32)VXGE_HW_RTS_ACCESS_STEER_DATA0_GET_FW_VER_DAY( | 
|  | 2935 | data1); | 
|  | 2936 | fw_date->month = | 
|  | 2937 | (u32)VXGE_HW_RTS_ACCESS_STEER_DATA0_GET_FW_VER_MONTH( | 
|  | 2938 | data1); | 
|  | 2939 | fw_date->year = | 
|  | 2940 | (u32)VXGE_HW_RTS_ACCESS_STEER_DATA0_GET_FW_VER_YEAR( | 
|  | 2941 | data1); | 
|  | 2942 |  | 
|  | 2943 | snprintf(fw_date->date, VXGE_HW_FW_STRLEN, "%2.2d/%2.2d/%4.4d", | 
|  | 2944 | fw_date->month, fw_date->day, fw_date->year); | 
|  | 2945 |  | 
|  | 2946 | fw_version->major = | 
|  | 2947 | (u32)VXGE_HW_RTS_ACCESS_STEER_DATA0_GET_FW_VER_MAJOR(data1); | 
|  | 2948 | fw_version->minor = | 
|  | 2949 | (u32)VXGE_HW_RTS_ACCESS_STEER_DATA0_GET_FW_VER_MINOR(data1); | 
|  | 2950 | fw_version->build = | 
|  | 2951 | (u32)VXGE_HW_RTS_ACCESS_STEER_DATA0_GET_FW_VER_BUILD(data1); | 
|  | 2952 |  | 
|  | 2953 | snprintf(fw_version->version, VXGE_HW_FW_STRLEN, "%d.%d.%d", | 
|  | 2954 | fw_version->major, fw_version->minor, fw_version->build); | 
|  | 2955 |  | 
|  | 2956 | flash_date->day = | 
|  | 2957 | (u32)VXGE_HW_RTS_ACCESS_STEER_DATA1_GET_FLASH_VER_DAY(data2); | 
|  | 2958 | flash_date->month = | 
|  | 2959 | (u32)VXGE_HW_RTS_ACCESS_STEER_DATA1_GET_FLASH_VER_MONTH(data2); | 
|  | 2960 | flash_date->year = | 
|  | 2961 | (u32)VXGE_HW_RTS_ACCESS_STEER_DATA1_GET_FLASH_VER_YEAR(data2); | 
|  | 2962 |  | 
|  | 2963 | snprintf(flash_date->date, VXGE_HW_FW_STRLEN, | 
|  | 2964 | "%2.2d/%2.2d/%4.4d", | 
|  | 2965 | flash_date->month, flash_date->day, flash_date->year); | 
|  | 2966 |  | 
|  | 2967 | flash_version->major = | 
|  | 2968 | (u32)VXGE_HW_RTS_ACCESS_STEER_DATA1_GET_FLASH_VER_MAJOR(data2); | 
|  | 2969 | flash_version->minor = | 
|  | 2970 | (u32)VXGE_HW_RTS_ACCESS_STEER_DATA1_GET_FLASH_VER_MINOR(data2); | 
|  | 2971 | flash_version->build = | 
|  | 2972 | (u32)VXGE_HW_RTS_ACCESS_STEER_DATA1_GET_FLASH_VER_BUILD(data2); | 
|  | 2973 |  | 
|  | 2974 | snprintf(flash_version->version, VXGE_HW_FW_STRLEN, "%d.%d.%d", | 
|  | 2975 | flash_version->major, flash_version->minor, | 
|  | 2976 | flash_version->build); | 
|  | 2977 |  | 
|  | 2978 | status = VXGE_HW_OK; | 
|  | 2979 |  | 
|  | 2980 | } else | 
|  | 2981 | status = VXGE_HW_FAIL; | 
|  | 2982 | exit: | 
|  | 2983 | return status; | 
|  | 2984 | } | 
|  | 2985 |  | 
|  | 2986 | /* | 
|  | 2987 | * __vxge_hw_vpath_pci_func_mode_get - Get the pci mode | 
|  | 2988 | * Returns pci function mode | 
|  | 2989 | */ | 
|  | 2990 | u64 | 
|  | 2991 | __vxge_hw_vpath_pci_func_mode_get( | 
|  | 2992 | u32  vp_id, | 
|  | 2993 | struct vxge_hw_vpath_reg __iomem *vpath_reg) | 
|  | 2994 | { | 
|  | 2995 | u64 val64; | 
|  | 2996 | u64 data1 = 0ULL; | 
|  | 2997 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 2998 |  | 
|  | 2999 | __vxge_hw_read_rts_ds(vpath_reg, | 
|  | 3000 | VXGE_HW_RTS_ACCESS_STEER_DATA0_MEMO_ITEM_PCI_MODE); | 
|  | 3001 |  | 
|  | 3002 | val64 = VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION( | 
|  | 3003 | VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION_READ_MEMO_ENTRY) | | 
|  | 3004 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL( | 
|  | 3005 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL_FW_MEMO) | | 
|  | 3006 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE | | 
|  | 3007 | VXGE_HW_RTS_ACCESS_STEER_CTRL_OFFSET(0); | 
|  | 3008 |  | 
|  | 3009 | status = __vxge_hw_pio_mem_write64(val64, | 
|  | 3010 | &vpath_reg->rts_access_steer_ctrl, | 
|  | 3011 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE, | 
|  | 3012 | VXGE_HW_DEF_DEVICE_POLL_MILLIS); | 
|  | 3013 |  | 
|  | 3014 | if (status != VXGE_HW_OK) | 
|  | 3015 | goto exit; | 
|  | 3016 |  | 
|  | 3017 | val64 = readq(&vpath_reg->rts_access_steer_ctrl); | 
|  | 3018 |  | 
|  | 3019 | if (val64 & VXGE_HW_RTS_ACCESS_STEER_CTRL_RMACJ_STATUS) { | 
|  | 3020 | data1 = readq(&vpath_reg->rts_access_steer_data0); | 
|  | 3021 | status = VXGE_HW_OK; | 
|  | 3022 | } else { | 
|  | 3023 | data1 = 0; | 
|  | 3024 | status = VXGE_HW_FAIL; | 
|  | 3025 | } | 
|  | 3026 | exit: | 
|  | 3027 | return data1; | 
|  | 3028 | } | 
|  | 3029 |  | 
|  | 3030 | /** | 
|  | 3031 | * vxge_hw_device_flick_link_led - Flick (blink) link LED. | 
|  | 3032 | * @hldev: HW device. | 
|  | 3033 | * @on_off: TRUE if flickering to be on, FALSE to be off | 
|  | 3034 | * | 
|  | 3035 | * Flicker the link LED. | 
|  | 3036 | */ | 
|  | 3037 | enum vxge_hw_status | 
|  | 3038 | vxge_hw_device_flick_link_led(struct __vxge_hw_device *hldev, | 
|  | 3039 | u64 on_off) | 
|  | 3040 | { | 
|  | 3041 | u64 val64; | 
|  | 3042 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 3043 | struct vxge_hw_vpath_reg __iomem *vp_reg; | 
|  | 3044 |  | 
|  | 3045 | if (hldev == NULL) { | 
|  | 3046 | status = VXGE_HW_ERR_INVALID_DEVICE; | 
|  | 3047 | goto exit; | 
|  | 3048 | } | 
|  | 3049 |  | 
|  | 3050 | vp_reg = hldev->vpath_reg[hldev->first_vp_id]; | 
|  | 3051 |  | 
|  | 3052 | writeq(0, &vp_reg->rts_access_steer_ctrl); | 
|  | 3053 | wmb(); | 
|  | 3054 | writeq(on_off, &vp_reg->rts_access_steer_data0); | 
|  | 3055 | writeq(0, &vp_reg->rts_access_steer_data1); | 
|  | 3056 | wmb(); | 
|  | 3057 |  | 
|  | 3058 | val64 = VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION( | 
|  | 3059 | VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION_LED_CONTROL) | | 
|  | 3060 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL( | 
|  | 3061 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL_FW_MEMO) | | 
|  | 3062 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE | | 
|  | 3063 | VXGE_HW_RTS_ACCESS_STEER_CTRL_OFFSET(0); | 
|  | 3064 |  | 
|  | 3065 | status = __vxge_hw_pio_mem_write64(val64, | 
|  | 3066 | &vp_reg->rts_access_steer_ctrl, | 
|  | 3067 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE, | 
|  | 3068 | VXGE_HW_DEF_DEVICE_POLL_MILLIS); | 
|  | 3069 | exit: | 
|  | 3070 | return status; | 
|  | 3071 | } | 
|  | 3072 |  | 
|  | 3073 | /* | 
|  | 3074 | * __vxge_hw_vpath_rts_table_get - Get the entries from RTS access tables | 
|  | 3075 | */ | 
|  | 3076 | enum vxge_hw_status | 
|  | 3077 | __vxge_hw_vpath_rts_table_get( | 
|  | 3078 | struct __vxge_hw_vpath_handle *vp, | 
|  | 3079 | u32 action, u32 rts_table, u32 offset, u64 *data1, u64 *data2) | 
|  | 3080 | { | 
|  | 3081 | u64 val64; | 
|  | 3082 | struct __vxge_hw_virtualpath *vpath; | 
|  | 3083 | struct vxge_hw_vpath_reg __iomem *vp_reg; | 
|  | 3084 |  | 
|  | 3085 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 3086 |  | 
|  | 3087 | if (vp == NULL) { | 
|  | 3088 | status = VXGE_HW_ERR_INVALID_HANDLE; | 
|  | 3089 | goto exit; | 
|  | 3090 | } | 
|  | 3091 |  | 
|  | 3092 | vpath = vp->vpath; | 
|  | 3093 | vp_reg = vpath->vp_reg; | 
|  | 3094 |  | 
|  | 3095 | val64 = VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION(action) | | 
|  | 3096 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL(rts_table) | | 
|  | 3097 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE | | 
|  | 3098 | VXGE_HW_RTS_ACCESS_STEER_CTRL_OFFSET(offset); | 
|  | 3099 |  | 
|  | 3100 | if ((rts_table == | 
|  | 3101 | VXGE_HW_RTS_ACS_STEER_CTRL_DATA_STRUCT_SEL_RTH_SOLO_IT) || | 
|  | 3102 | (rts_table == | 
|  | 3103 | VXGE_HW_RTS_ACS_STEER_CTRL_DATA_STRUCT_SEL_RTH_MULTI_IT) || | 
|  | 3104 | (rts_table == | 
|  | 3105 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL_RTH_MASK) || | 
|  | 3106 | (rts_table == | 
|  | 3107 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL_RTH_KEY)) { | 
|  | 3108 | val64 = val64 |	VXGE_HW_RTS_ACCESS_STEER_CTRL_TABLE_SEL; | 
|  | 3109 | } | 
|  | 3110 |  | 
|  | 3111 | status = __vxge_hw_pio_mem_write64(val64, | 
|  | 3112 | &vp_reg->rts_access_steer_ctrl, | 
|  | 3113 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE, | 
|  | 3114 | vpath->hldev->config.device_poll_millis); | 
|  | 3115 |  | 
|  | 3116 | if (status != VXGE_HW_OK) | 
|  | 3117 | goto exit; | 
|  | 3118 |  | 
|  | 3119 | val64 = readq(&vp_reg->rts_access_steer_ctrl); | 
|  | 3120 |  | 
|  | 3121 | if (val64 & VXGE_HW_RTS_ACCESS_STEER_CTRL_RMACJ_STATUS) { | 
|  | 3122 |  | 
|  | 3123 | *data1 = readq(&vp_reg->rts_access_steer_data0); | 
|  | 3124 |  | 
|  | 3125 | if ((rts_table == | 
|  | 3126 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL_DA) || | 
|  | 3127 | (rts_table == | 
|  | 3128 | VXGE_HW_RTS_ACS_STEER_CTRL_DATA_STRUCT_SEL_RTH_MULTI_IT)) { | 
|  | 3129 | *data2 = readq(&vp_reg->rts_access_steer_data1); | 
|  | 3130 | } | 
|  | 3131 | status = VXGE_HW_OK; | 
|  | 3132 | } else | 
|  | 3133 | status = VXGE_HW_FAIL; | 
|  | 3134 | exit: | 
|  | 3135 | return status; | 
|  | 3136 | } | 
|  | 3137 |  | 
|  | 3138 | /* | 
|  | 3139 | * __vxge_hw_vpath_rts_table_set - Set the entries of RTS access tables | 
|  | 3140 | */ | 
|  | 3141 | enum vxge_hw_status | 
|  | 3142 | __vxge_hw_vpath_rts_table_set( | 
|  | 3143 | struct __vxge_hw_vpath_handle *vp, u32 action, u32 rts_table, | 
|  | 3144 | u32 offset, u64 data1, u64 data2) | 
|  | 3145 | { | 
|  | 3146 | u64 val64; | 
|  | 3147 | struct __vxge_hw_virtualpath *vpath; | 
|  | 3148 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 3149 | struct vxge_hw_vpath_reg __iomem *vp_reg; | 
|  | 3150 |  | 
|  | 3151 | if (vp == NULL) { | 
|  | 3152 | status = VXGE_HW_ERR_INVALID_HANDLE; | 
|  | 3153 | goto exit; | 
|  | 3154 | } | 
|  | 3155 |  | 
|  | 3156 | vpath = vp->vpath; | 
|  | 3157 | vp_reg = vpath->vp_reg; | 
|  | 3158 |  | 
|  | 3159 | writeq(data1, &vp_reg->rts_access_steer_data0); | 
|  | 3160 | wmb(); | 
|  | 3161 |  | 
|  | 3162 | if ((rts_table == VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL_DA) || | 
|  | 3163 | (rts_table == | 
|  | 3164 | VXGE_HW_RTS_ACS_STEER_CTRL_DATA_STRUCT_SEL_RTH_MULTI_IT)) { | 
|  | 3165 | writeq(data2, &vp_reg->rts_access_steer_data1); | 
|  | 3166 | wmb(); | 
|  | 3167 | } | 
|  | 3168 |  | 
|  | 3169 | val64 = VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION(action) | | 
|  | 3170 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL(rts_table) | | 
|  | 3171 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE | | 
|  | 3172 | VXGE_HW_RTS_ACCESS_STEER_CTRL_OFFSET(offset); | 
|  | 3173 |  | 
|  | 3174 | status = __vxge_hw_pio_mem_write64(val64, | 
|  | 3175 | &vp_reg->rts_access_steer_ctrl, | 
|  | 3176 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE, | 
|  | 3177 | vpath->hldev->config.device_poll_millis); | 
|  | 3178 |  | 
|  | 3179 | if (status != VXGE_HW_OK) | 
|  | 3180 | goto exit; | 
|  | 3181 |  | 
|  | 3182 | val64 = readq(&vp_reg->rts_access_steer_ctrl); | 
|  | 3183 |  | 
|  | 3184 | if (val64 & VXGE_HW_RTS_ACCESS_STEER_CTRL_RMACJ_STATUS) | 
|  | 3185 | status = VXGE_HW_OK; | 
|  | 3186 | else | 
|  | 3187 | status = VXGE_HW_FAIL; | 
|  | 3188 | exit: | 
|  | 3189 | return status; | 
|  | 3190 | } | 
|  | 3191 |  | 
|  | 3192 | /* | 
|  | 3193 | * __vxge_hw_vpath_addr_get - Get the hw address entry for this vpath | 
|  | 3194 | *               from MAC address table. | 
|  | 3195 | */ | 
|  | 3196 | enum vxge_hw_status | 
|  | 3197 | __vxge_hw_vpath_addr_get( | 
|  | 3198 | u32 vp_id, struct vxge_hw_vpath_reg __iomem *vpath_reg, | 
|  | 3199 | u8 (macaddr)[ETH_ALEN], u8 (macaddr_mask)[ETH_ALEN]) | 
|  | 3200 | { | 
|  | 3201 | u32 i; | 
|  | 3202 | u64 val64; | 
|  | 3203 | u64 data1 = 0ULL; | 
|  | 3204 | u64 data2 = 0ULL; | 
|  | 3205 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 3206 |  | 
|  | 3207 | val64 = VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION( | 
|  | 3208 | VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION_LIST_FIRST_ENTRY) | | 
|  | 3209 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL( | 
|  | 3210 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL_DA) | | 
|  | 3211 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE | | 
|  | 3212 | VXGE_HW_RTS_ACCESS_STEER_CTRL_OFFSET(0); | 
|  | 3213 |  | 
|  | 3214 | status = __vxge_hw_pio_mem_write64(val64, | 
|  | 3215 | &vpath_reg->rts_access_steer_ctrl, | 
|  | 3216 | VXGE_HW_RTS_ACCESS_STEER_CTRL_STROBE, | 
|  | 3217 | VXGE_HW_DEF_DEVICE_POLL_MILLIS); | 
|  | 3218 |  | 
|  | 3219 | if (status != VXGE_HW_OK) | 
|  | 3220 | goto exit; | 
|  | 3221 |  | 
|  | 3222 | val64 = readq(&vpath_reg->rts_access_steer_ctrl); | 
|  | 3223 |  | 
|  | 3224 | if (val64 & VXGE_HW_RTS_ACCESS_STEER_CTRL_RMACJ_STATUS) { | 
|  | 3225 |  | 
|  | 3226 | data1 = readq(&vpath_reg->rts_access_steer_data0); | 
|  | 3227 | data2 = readq(&vpath_reg->rts_access_steer_data1); | 
|  | 3228 |  | 
|  | 3229 | data1 = VXGE_HW_RTS_ACCESS_STEER_DATA0_GET_DA_MAC_ADDR(data1); | 
|  | 3230 | data2 = VXGE_HW_RTS_ACCESS_STEER_DATA1_GET_DA_MAC_ADDR_MASK( | 
|  | 3231 | data2); | 
|  | 3232 |  | 
|  | 3233 | for (i = ETH_ALEN; i > 0; i--) { | 
|  | 3234 | macaddr[i-1] = (u8)(data1 & 0xFF); | 
|  | 3235 | data1 >>= 8; | 
|  | 3236 |  | 
|  | 3237 | macaddr_mask[i-1] = (u8)(data2 & 0xFF); | 
|  | 3238 | data2 >>= 8; | 
|  | 3239 | } | 
|  | 3240 | status = VXGE_HW_OK; | 
|  | 3241 | } else | 
|  | 3242 | status = VXGE_HW_FAIL; | 
|  | 3243 | exit: | 
|  | 3244 | return status; | 
|  | 3245 | } | 
|  | 3246 |  | 
|  | 3247 | /* | 
|  | 3248 | * vxge_hw_vpath_rts_rth_set - Set/configure RTS hashing. | 
|  | 3249 | */ | 
|  | 3250 | enum vxge_hw_status vxge_hw_vpath_rts_rth_set( | 
|  | 3251 | struct __vxge_hw_vpath_handle *vp, | 
|  | 3252 | enum vxge_hw_rth_algoritms algorithm, | 
|  | 3253 | struct vxge_hw_rth_hash_types *hash_type, | 
|  | 3254 | u16 bucket_size) | 
|  | 3255 | { | 
|  | 3256 | u64 data0, data1; | 
|  | 3257 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 3258 |  | 
|  | 3259 | if (vp == NULL) { | 
|  | 3260 | status = VXGE_HW_ERR_INVALID_HANDLE; | 
|  | 3261 | goto exit; | 
|  | 3262 | } | 
|  | 3263 |  | 
|  | 3264 | status = __vxge_hw_vpath_rts_table_get(vp, | 
|  | 3265 | VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION_READ_ENTRY, | 
|  | 3266 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL_RTH_GEN_CFG, | 
|  | 3267 | 0, &data0, &data1); | 
|  | 3268 |  | 
|  | 3269 | data0 &= ~(VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_GEN_BUCKET_SIZE(0xf) | | 
|  | 3270 | VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_GEN_ALG_SEL(0x3)); | 
|  | 3271 |  | 
|  | 3272 | data0 |= VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_GEN_RTH_EN | | 
|  | 3273 | VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_GEN_BUCKET_SIZE(bucket_size) | | 
|  | 3274 | VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_GEN_ALG_SEL(algorithm); | 
|  | 3275 |  | 
|  | 3276 | if (hash_type->hash_type_tcpipv4_en) | 
|  | 3277 | data0 |= VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_GEN_RTH_TCP_IPV4_EN; | 
|  | 3278 |  | 
|  | 3279 | if (hash_type->hash_type_ipv4_en) | 
|  | 3280 | data0 |= VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_GEN_RTH_IPV4_EN; | 
|  | 3281 |  | 
|  | 3282 | if (hash_type->hash_type_tcpipv6_en) | 
|  | 3283 | data0 |= VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_GEN_RTH_TCP_IPV6_EN; | 
|  | 3284 |  | 
|  | 3285 | if (hash_type->hash_type_ipv6_en) | 
|  | 3286 | data0 |= VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_GEN_RTH_IPV6_EN; | 
|  | 3287 |  | 
|  | 3288 | if (hash_type->hash_type_tcpipv6ex_en) | 
|  | 3289 | data0 |= | 
|  | 3290 | VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_GEN_RTH_TCP_IPV6_EX_EN; | 
|  | 3291 |  | 
|  | 3292 | if (hash_type->hash_type_ipv6ex_en) | 
|  | 3293 | data0 |= VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_GEN_RTH_IPV6_EX_EN; | 
|  | 3294 |  | 
|  | 3295 | if (VXGE_HW_RTS_ACCESS_STEER_DATA0_GET_RTH_GEN_ACTIVE_TABLE(data0)) | 
|  | 3296 | data0 &= ~VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_GEN_ACTIVE_TABLE; | 
|  | 3297 | else | 
|  | 3298 | data0 |= VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_GEN_ACTIVE_TABLE; | 
|  | 3299 |  | 
|  | 3300 | status = __vxge_hw_vpath_rts_table_set(vp, | 
|  | 3301 | VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION_WRITE_ENTRY, | 
|  | 3302 | VXGE_HW_RTS_ACCESS_STEER_CTRL_DATA_STRUCT_SEL_RTH_GEN_CFG, | 
|  | 3303 | 0, data0, 0); | 
|  | 3304 | exit: | 
|  | 3305 | return status; | 
|  | 3306 | } | 
|  | 3307 |  | 
|  | 3308 | static void | 
|  | 3309 | vxge_hw_rts_rth_data0_data1_get(u32 j, u64 *data0, u64 *data1, | 
|  | 3310 | u16 flag, u8 *itable) | 
|  | 3311 | { | 
|  | 3312 | switch (flag) { | 
|  | 3313 | case 1: | 
|  | 3314 | *data0 = VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_ITEM0_BUCKET_NUM(j)| | 
|  | 3315 | VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_ITEM0_ENTRY_EN | | 
|  | 3316 | VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_ITEM0_BUCKET_DATA( | 
|  | 3317 | itable[j]); | 
|  | 3318 | case 2: | 
|  | 3319 | *data0 |= | 
|  | 3320 | VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_ITEM1_BUCKET_NUM(j)| | 
|  | 3321 | VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_ITEM1_ENTRY_EN | | 
|  | 3322 | VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_ITEM1_BUCKET_DATA( | 
|  | 3323 | itable[j]); | 
|  | 3324 | case 3: | 
|  | 3325 | *data1 = VXGE_HW_RTS_ACCESS_STEER_DATA1_RTH_ITEM0_BUCKET_NUM(j)| | 
|  | 3326 | VXGE_HW_RTS_ACCESS_STEER_DATA1_RTH_ITEM0_ENTRY_EN | | 
|  | 3327 | VXGE_HW_RTS_ACCESS_STEER_DATA1_RTH_ITEM0_BUCKET_DATA( | 
|  | 3328 | itable[j]); | 
|  | 3329 | case 4: | 
|  | 3330 | *data1 |= | 
|  | 3331 | VXGE_HW_RTS_ACCESS_STEER_DATA1_RTH_ITEM1_BUCKET_NUM(j)| | 
|  | 3332 | VXGE_HW_RTS_ACCESS_STEER_DATA1_RTH_ITEM1_ENTRY_EN | | 
|  | 3333 | VXGE_HW_RTS_ACCESS_STEER_DATA1_RTH_ITEM1_BUCKET_DATA( | 
|  | 3334 | itable[j]); | 
|  | 3335 | default: | 
|  | 3336 | return; | 
|  | 3337 | } | 
|  | 3338 | } | 
|  | 3339 | /* | 
|  | 3340 | * vxge_hw_vpath_rts_rth_itable_set - Set/configure indirection table (IT). | 
|  | 3341 | */ | 
|  | 3342 | enum vxge_hw_status vxge_hw_vpath_rts_rth_itable_set( | 
|  | 3343 | struct __vxge_hw_vpath_handle **vpath_handles, | 
|  | 3344 | u32 vpath_count, | 
|  | 3345 | u8 *mtable, | 
|  | 3346 | u8 *itable, | 
|  | 3347 | u32 itable_size) | 
|  | 3348 | { | 
|  | 3349 | u32 i, j, action, rts_table; | 
|  | 3350 | u64 data0; | 
|  | 3351 | u64 data1; | 
|  | 3352 | u32 max_entries; | 
|  | 3353 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 3354 | struct __vxge_hw_vpath_handle *vp = vpath_handles[0]; | 
|  | 3355 |  | 
|  | 3356 | if (vp == NULL) { | 
|  | 3357 | status = VXGE_HW_ERR_INVALID_HANDLE; | 
|  | 3358 | goto exit; | 
|  | 3359 | } | 
|  | 3360 |  | 
|  | 3361 | max_entries = (((u32)1) << itable_size); | 
|  | 3362 |  | 
|  | 3363 | if (vp->vpath->hldev->config.rth_it_type | 
|  | 3364 | == VXGE_HW_RTH_IT_TYPE_SOLO_IT) { | 
|  | 3365 | action = VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION_WRITE_ENTRY; | 
|  | 3366 | rts_table = | 
|  | 3367 | VXGE_HW_RTS_ACS_STEER_CTRL_DATA_STRUCT_SEL_RTH_SOLO_IT; | 
|  | 3368 |  | 
|  | 3369 | for (j = 0; j < max_entries; j++) { | 
|  | 3370 |  | 
|  | 3371 | data1 = 0; | 
|  | 3372 |  | 
|  | 3373 | data0 = | 
|  | 3374 | VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_SOLO_IT_BUCKET_DATA( | 
|  | 3375 | itable[j]); | 
|  | 3376 |  | 
|  | 3377 | status = __vxge_hw_vpath_rts_table_set(vpath_handles[0], | 
|  | 3378 | action, rts_table, j, data0, data1); | 
|  | 3379 |  | 
|  | 3380 | if (status != VXGE_HW_OK) | 
|  | 3381 | goto exit; | 
|  | 3382 | } | 
|  | 3383 |  | 
|  | 3384 | for (j = 0; j < max_entries; j++) { | 
|  | 3385 |  | 
|  | 3386 | data1 = 0; | 
|  | 3387 |  | 
|  | 3388 | data0 = | 
|  | 3389 | VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_SOLO_IT_ENTRY_EN | | 
|  | 3390 | VXGE_HW_RTS_ACCESS_STEER_DATA0_RTH_SOLO_IT_BUCKET_DATA( | 
|  | 3391 | itable[j]); | 
|  | 3392 |  | 
|  | 3393 | status = __vxge_hw_vpath_rts_table_set( | 
|  | 3394 | vpath_handles[mtable[itable[j]]], action, | 
|  | 3395 | rts_table, j, data0, data1); | 
|  | 3396 |  | 
|  | 3397 | if (status != VXGE_HW_OK) | 
|  | 3398 | goto exit; | 
|  | 3399 | } | 
|  | 3400 | } else { | 
|  | 3401 | action = VXGE_HW_RTS_ACCESS_STEER_CTRL_ACTION_WRITE_ENTRY; | 
|  | 3402 | rts_table = | 
|  | 3403 | VXGE_HW_RTS_ACS_STEER_CTRL_DATA_STRUCT_SEL_RTH_MULTI_IT; | 
|  | 3404 | for (i = 0; i < vpath_count; i++) { | 
|  | 3405 |  | 
|  | 3406 | for (j = 0; j < max_entries;) { | 
|  | 3407 |  | 
|  | 3408 | data0 = 0; | 
|  | 3409 | data1 = 0; | 
|  | 3410 |  | 
|  | 3411 | while (j < max_entries) { | 
|  | 3412 | if (mtable[itable[j]] != i) { | 
|  | 3413 | j++; | 
|  | 3414 | continue; | 
|  | 3415 | } | 
|  | 3416 | vxge_hw_rts_rth_data0_data1_get(j, | 
|  | 3417 | &data0, &data1, 1, itable); | 
|  | 3418 | j++; | 
|  | 3419 | break; | 
|  | 3420 | } | 
|  | 3421 |  | 
|  | 3422 | while (j < max_entries) { | 
|  | 3423 | if (mtable[itable[j]] != i) { | 
|  | 3424 | j++; | 
|  | 3425 | continue; | 
|  | 3426 | } | 
|  | 3427 | vxge_hw_rts_rth_data0_data1_get(j, | 
|  | 3428 | &data0, &data1, 2, itable); | 
|  | 3429 | j++; | 
|  | 3430 | break; | 
|  | 3431 | } | 
|  | 3432 |  | 
|  | 3433 | while (j < max_entries) { | 
|  | 3434 | if (mtable[itable[j]] != i) { | 
|  | 3435 | j++; | 
|  | 3436 | continue; | 
|  | 3437 | } | 
|  | 3438 | vxge_hw_rts_rth_data0_data1_get(j, | 
|  | 3439 | &data0, &data1, 3, itable); | 
|  | 3440 | j++; | 
|  | 3441 | break; | 
|  | 3442 | } | 
|  | 3443 |  | 
|  | 3444 | while (j < max_entries) { | 
|  | 3445 | if (mtable[itable[j]] != i) { | 
|  | 3446 | j++; | 
|  | 3447 | continue; | 
|  | 3448 | } | 
|  | 3449 | vxge_hw_rts_rth_data0_data1_get(j, | 
|  | 3450 | &data0, &data1, 4, itable); | 
|  | 3451 | j++; | 
|  | 3452 | break; | 
|  | 3453 | } | 
|  | 3454 |  | 
|  | 3455 | if (data0 != 0) { | 
|  | 3456 | status = __vxge_hw_vpath_rts_table_set( | 
|  | 3457 | vpath_handles[i], | 
|  | 3458 | action, rts_table, | 
|  | 3459 | 0, data0, data1); | 
|  | 3460 |  | 
|  | 3461 | if (status != VXGE_HW_OK) | 
|  | 3462 | goto exit; | 
|  | 3463 | } | 
|  | 3464 | } | 
|  | 3465 | } | 
|  | 3466 | } | 
|  | 3467 | exit: | 
|  | 3468 | return status; | 
|  | 3469 | } | 
|  | 3470 |  | 
|  | 3471 | /** | 
|  | 3472 | * vxge_hw_vpath_check_leak - Check for memory leak | 
|  | 3473 | * @ringh: Handle to the ring object used for receive | 
|  | 3474 | * | 
|  | 3475 | * If PRC_RXD_DOORBELL_VPn.NEW_QW_CNT is larger or equal to | 
|  | 3476 | * PRC_CFG6_VPn.RXD_SPAT then a leak has occurred. | 
|  | 3477 | * Returns: VXGE_HW_FAIL, if leak has occurred. | 
|  | 3478 | * | 
|  | 3479 | */ | 
|  | 3480 | enum vxge_hw_status | 
|  | 3481 | vxge_hw_vpath_check_leak(struct __vxge_hw_ring *ring) | 
|  | 3482 | { | 
|  | 3483 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 3484 | u64 rxd_new_count, rxd_spat; | 
|  | 3485 |  | 
|  | 3486 | if (ring == NULL) | 
|  | 3487 | return status; | 
|  | 3488 |  | 
|  | 3489 | rxd_new_count = readl(&ring->vp_reg->prc_rxd_doorbell); | 
|  | 3490 | rxd_spat = readq(&ring->vp_reg->prc_cfg6); | 
|  | 3491 | rxd_spat = VXGE_HW_PRC_CFG6_RXD_SPAT(rxd_spat); | 
|  | 3492 |  | 
|  | 3493 | if (rxd_new_count >= rxd_spat) | 
|  | 3494 | status = VXGE_HW_FAIL; | 
|  | 3495 |  | 
|  | 3496 | return status; | 
|  | 3497 | } | 
|  | 3498 |  | 
|  | 3499 | /* | 
|  | 3500 | * __vxge_hw_vpath_mgmt_read | 
|  | 3501 | * This routine reads the vpath_mgmt registers | 
|  | 3502 | */ | 
|  | 3503 | static enum vxge_hw_status | 
|  | 3504 | __vxge_hw_vpath_mgmt_read( | 
|  | 3505 | struct __vxge_hw_device *hldev, | 
|  | 3506 | struct __vxge_hw_virtualpath *vpath) | 
|  | 3507 | { | 
|  | 3508 | u32 i, mtu = 0, max_pyld = 0; | 
|  | 3509 | u64 val64; | 
|  | 3510 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 3511 |  | 
|  | 3512 | for (i = 0; i < VXGE_HW_MAC_MAX_MAC_PORT_ID; i++) { | 
|  | 3513 |  | 
|  | 3514 | val64 = readq(&vpath->vpmgmt_reg-> | 
|  | 3515 | rxmac_cfg0_port_vpmgmt_clone[i]); | 
|  | 3516 | max_pyld = | 
|  | 3517 | (u32) | 
|  | 3518 | VXGE_HW_RXMAC_CFG0_PORT_VPMGMT_CLONE_GET_MAX_PYLD_LEN | 
|  | 3519 | (val64); | 
|  | 3520 | if (mtu < max_pyld) | 
|  | 3521 | mtu = max_pyld; | 
|  | 3522 | } | 
|  | 3523 |  | 
|  | 3524 | vpath->max_mtu = mtu + VXGE_HW_MAC_HEADER_MAX_SIZE; | 
|  | 3525 |  | 
|  | 3526 | val64 = readq(&vpath->vpmgmt_reg->xmac_vsport_choices_vp); | 
|  | 3527 |  | 
|  | 3528 | for (i = 0; i < VXGE_HW_MAX_VIRTUAL_PATHS; i++) { | 
|  | 3529 | if (val64 & vxge_mBIT(i)) | 
|  | 3530 | vpath->vsport_number = i; | 
|  | 3531 | } | 
|  | 3532 |  | 
|  | 3533 | val64 = readq(&vpath->vpmgmt_reg->xgmac_gen_status_vpmgmt_clone); | 
|  | 3534 |  | 
|  | 3535 | if (val64 & VXGE_HW_XGMAC_GEN_STATUS_VPMGMT_CLONE_XMACJ_NTWK_OK) | 
|  | 3536 | VXGE_HW_DEVICE_LINK_STATE_SET(vpath->hldev, VXGE_HW_LINK_UP); | 
|  | 3537 | else | 
|  | 3538 | VXGE_HW_DEVICE_LINK_STATE_SET(vpath->hldev, VXGE_HW_LINK_DOWN); | 
|  | 3539 |  | 
|  | 3540 | return status; | 
|  | 3541 | } | 
|  | 3542 |  | 
|  | 3543 | /* | 
|  | 3544 | * __vxge_hw_vpath_reset_check - Check if resetting the vpath completed | 
|  | 3545 | * This routine checks the vpath_rst_in_prog register to see if | 
|  | 3546 | * adapter completed the reset process for the vpath | 
|  | 3547 | */ | 
|  | 3548 | enum vxge_hw_status | 
|  | 3549 | __vxge_hw_vpath_reset_check(struct __vxge_hw_virtualpath *vpath) | 
|  | 3550 | { | 
|  | 3551 | enum vxge_hw_status status; | 
|  | 3552 |  | 
|  | 3553 | status = __vxge_hw_device_register_poll( | 
|  | 3554 | &vpath->hldev->common_reg->vpath_rst_in_prog, | 
|  | 3555 | VXGE_HW_VPATH_RST_IN_PROG_VPATH_RST_IN_PROG( | 
|  | 3556 | 1 << (16 - vpath->vp_id)), | 
|  | 3557 | vpath->hldev->config.device_poll_millis); | 
|  | 3558 |  | 
|  | 3559 | return status; | 
|  | 3560 | } | 
|  | 3561 |  | 
|  | 3562 | /* | 
|  | 3563 | * __vxge_hw_vpath_reset | 
|  | 3564 | * This routine resets the vpath on the device | 
|  | 3565 | */ | 
|  | 3566 | enum vxge_hw_status | 
|  | 3567 | __vxge_hw_vpath_reset(struct __vxge_hw_device *hldev, u32 vp_id) | 
|  | 3568 | { | 
|  | 3569 | u64 val64; | 
|  | 3570 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 3571 |  | 
|  | 3572 | val64 = VXGE_HW_CMN_RSTHDLR_CFG0_SW_RESET_VPATH(1 << (16 - vp_id)); | 
|  | 3573 |  | 
|  | 3574 | __vxge_hw_pio_mem_write32_upper((u32)vxge_bVALn(val64, 0, 32), | 
|  | 3575 | &hldev->common_reg->cmn_rsthdlr_cfg0); | 
|  | 3576 |  | 
|  | 3577 | return status; | 
|  | 3578 | } | 
|  | 3579 |  | 
|  | 3580 | /* | 
|  | 3581 | * __vxge_hw_vpath_sw_reset | 
|  | 3582 | * This routine resets the vpath structures | 
|  | 3583 | */ | 
|  | 3584 | enum vxge_hw_status | 
|  | 3585 | __vxge_hw_vpath_sw_reset(struct __vxge_hw_device *hldev, u32 vp_id) | 
|  | 3586 | { | 
|  | 3587 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 3588 | struct __vxge_hw_virtualpath *vpath; | 
|  | 3589 |  | 
|  | 3590 | vpath = (struct __vxge_hw_virtualpath *)&hldev->virtual_paths[vp_id]; | 
|  | 3591 |  | 
|  | 3592 | if (vpath->ringh) { | 
|  | 3593 | status = __vxge_hw_ring_reset(vpath->ringh); | 
|  | 3594 | if (status != VXGE_HW_OK) | 
|  | 3595 | goto exit; | 
|  | 3596 | } | 
|  | 3597 |  | 
|  | 3598 | if (vpath->fifoh) | 
|  | 3599 | status = __vxge_hw_fifo_reset(vpath->fifoh); | 
|  | 3600 | exit: | 
|  | 3601 | return status; | 
|  | 3602 | } | 
|  | 3603 |  | 
|  | 3604 | /* | 
|  | 3605 | * __vxge_hw_vpath_prc_configure | 
|  | 3606 | * This routine configures the prc registers of virtual path using the config | 
|  | 3607 | * passed | 
|  | 3608 | */ | 
|  | 3609 | void | 
|  | 3610 | __vxge_hw_vpath_prc_configure(struct __vxge_hw_device *hldev, u32 vp_id) | 
|  | 3611 | { | 
|  | 3612 | u64 val64; | 
|  | 3613 | struct __vxge_hw_virtualpath *vpath; | 
|  | 3614 | struct vxge_hw_vp_config *vp_config; | 
|  | 3615 | struct vxge_hw_vpath_reg __iomem *vp_reg; | 
|  | 3616 |  | 
|  | 3617 | vpath = &hldev->virtual_paths[vp_id]; | 
|  | 3618 | vp_reg = vpath->vp_reg; | 
|  | 3619 | vp_config = vpath->vp_config; | 
|  | 3620 |  | 
|  | 3621 | if (vp_config->ring.enable == VXGE_HW_RING_DISABLE) | 
|  | 3622 | return; | 
|  | 3623 |  | 
|  | 3624 | val64 = readq(&vp_reg->prc_cfg1); | 
|  | 3625 | val64 |= VXGE_HW_PRC_CFG1_RTI_TINT_DISABLE; | 
|  | 3626 | writeq(val64, &vp_reg->prc_cfg1); | 
|  | 3627 |  | 
|  | 3628 | val64 = readq(&vpath->vp_reg->prc_cfg6); | 
|  | 3629 | val64 |= VXGE_HW_PRC_CFG6_DOORBELL_MODE_EN; | 
|  | 3630 | writeq(val64, &vpath->vp_reg->prc_cfg6); | 
|  | 3631 |  | 
|  | 3632 | val64 = readq(&vp_reg->prc_cfg7); | 
|  | 3633 |  | 
|  | 3634 | if (vpath->vp_config->ring.scatter_mode != | 
|  | 3635 | VXGE_HW_RING_SCATTER_MODE_USE_FLASH_DEFAULT) { | 
|  | 3636 |  | 
|  | 3637 | val64 &= ~VXGE_HW_PRC_CFG7_SCATTER_MODE(0x3); | 
|  | 3638 |  | 
|  | 3639 | switch (vpath->vp_config->ring.scatter_mode) { | 
|  | 3640 | case VXGE_HW_RING_SCATTER_MODE_A: | 
|  | 3641 | val64 |= VXGE_HW_PRC_CFG7_SCATTER_MODE( | 
|  | 3642 | VXGE_HW_PRC_CFG7_SCATTER_MODE_A); | 
|  | 3643 | break; | 
|  | 3644 | case VXGE_HW_RING_SCATTER_MODE_B: | 
|  | 3645 | val64 |= VXGE_HW_PRC_CFG7_SCATTER_MODE( | 
|  | 3646 | VXGE_HW_PRC_CFG7_SCATTER_MODE_B); | 
|  | 3647 | break; | 
|  | 3648 | case VXGE_HW_RING_SCATTER_MODE_C: | 
|  | 3649 | val64 |= VXGE_HW_PRC_CFG7_SCATTER_MODE( | 
|  | 3650 | VXGE_HW_PRC_CFG7_SCATTER_MODE_C); | 
|  | 3651 | break; | 
|  | 3652 | } | 
|  | 3653 | } | 
|  | 3654 |  | 
|  | 3655 | writeq(val64, &vp_reg->prc_cfg7); | 
|  | 3656 |  | 
|  | 3657 | writeq(VXGE_HW_PRC_CFG5_RXD0_ADD( | 
|  | 3658 | __vxge_hw_ring_first_block_address_get( | 
|  | 3659 | vpath->ringh) >> 3), &vp_reg->prc_cfg5); | 
|  | 3660 |  | 
|  | 3661 | val64 = readq(&vp_reg->prc_cfg4); | 
|  | 3662 | val64 |= VXGE_HW_PRC_CFG4_IN_SVC; | 
|  | 3663 | val64 &= ~VXGE_HW_PRC_CFG4_RING_MODE(0x3); | 
|  | 3664 |  | 
|  | 3665 | val64 |= VXGE_HW_PRC_CFG4_RING_MODE( | 
|  | 3666 | VXGE_HW_PRC_CFG4_RING_MODE_ONE_BUFFER); | 
|  | 3667 |  | 
|  | 3668 | if (hldev->config.rth_en == VXGE_HW_RTH_DISABLE) | 
|  | 3669 | val64 |= VXGE_HW_PRC_CFG4_RTH_DISABLE; | 
|  | 3670 | else | 
|  | 3671 | val64 &= ~VXGE_HW_PRC_CFG4_RTH_DISABLE; | 
|  | 3672 |  | 
|  | 3673 | writeq(val64, &vp_reg->prc_cfg4); | 
|  | 3674 | return; | 
|  | 3675 | } | 
|  | 3676 |  | 
|  | 3677 | /* | 
|  | 3678 | * __vxge_hw_vpath_kdfc_configure | 
|  | 3679 | * This routine configures the kdfc registers of virtual path using the | 
|  | 3680 | * config passed | 
|  | 3681 | */ | 
|  | 3682 | enum vxge_hw_status | 
|  | 3683 | __vxge_hw_vpath_kdfc_configure(struct __vxge_hw_device *hldev, u32 vp_id) | 
|  | 3684 | { | 
|  | 3685 | u64 val64; | 
|  | 3686 | u64 vpath_stride; | 
|  | 3687 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 3688 | struct __vxge_hw_virtualpath *vpath; | 
|  | 3689 | struct vxge_hw_vpath_reg __iomem *vp_reg; | 
|  | 3690 |  | 
|  | 3691 | vpath = &hldev->virtual_paths[vp_id]; | 
|  | 3692 | vp_reg = vpath->vp_reg; | 
|  | 3693 | status = __vxge_hw_kdfc_swapper_set(hldev->legacy_reg, vp_reg); | 
|  | 3694 |  | 
|  | 3695 | if (status != VXGE_HW_OK) | 
|  | 3696 | goto exit; | 
|  | 3697 |  | 
|  | 3698 | val64 = readq(&vp_reg->kdfc_drbl_triplet_total); | 
|  | 3699 |  | 
|  | 3700 | vpath->max_kdfc_db = | 
|  | 3701 | (u32)VXGE_HW_KDFC_DRBL_TRIPLET_TOTAL_GET_KDFC_MAX_SIZE( | 
|  | 3702 | val64+1)/2; | 
|  | 3703 |  | 
|  | 3704 | if (vpath->vp_config->fifo.enable == VXGE_HW_FIFO_ENABLE) { | 
|  | 3705 |  | 
|  | 3706 | vpath->max_nofl_db = vpath->max_kdfc_db; | 
|  | 3707 |  | 
|  | 3708 | if (vpath->max_nofl_db < | 
|  | 3709 | ((vpath->vp_config->fifo.memblock_size / | 
|  | 3710 | (vpath->vp_config->fifo.max_frags * | 
|  | 3711 | sizeof(struct vxge_hw_fifo_txd))) * | 
|  | 3712 | vpath->vp_config->fifo.fifo_blocks)) { | 
|  | 3713 |  | 
|  | 3714 | return VXGE_HW_BADCFG_FIFO_BLOCKS; | 
|  | 3715 | } | 
|  | 3716 | val64 = VXGE_HW_KDFC_FIFO_TRPL_PARTITION_LENGTH_0( | 
|  | 3717 | (vpath->max_nofl_db*2)-1); | 
|  | 3718 | } | 
|  | 3719 |  | 
|  | 3720 | writeq(val64, &vp_reg->kdfc_fifo_trpl_partition); | 
|  | 3721 |  | 
|  | 3722 | writeq(VXGE_HW_KDFC_FIFO_TRPL_CTRL_TRIPLET_ENABLE, | 
|  | 3723 | &vp_reg->kdfc_fifo_trpl_ctrl); | 
|  | 3724 |  | 
|  | 3725 | val64 = readq(&vp_reg->kdfc_trpl_fifo_0_ctrl); | 
|  | 3726 |  | 
|  | 3727 | val64 &= ~(VXGE_HW_KDFC_TRPL_FIFO_0_CTRL_MODE(0x3) | | 
|  | 3728 | VXGE_HW_KDFC_TRPL_FIFO_0_CTRL_SELECT(0xFF)); | 
|  | 3729 |  | 
|  | 3730 | val64 |= VXGE_HW_KDFC_TRPL_FIFO_0_CTRL_MODE( | 
|  | 3731 | VXGE_HW_KDFC_TRPL_FIFO_0_CTRL_MODE_NON_OFFLOAD_ONLY) | | 
|  | 3732 | #ifndef __BIG_ENDIAN | 
|  | 3733 | VXGE_HW_KDFC_TRPL_FIFO_0_CTRL_SWAP_EN | | 
|  | 3734 | #endif | 
|  | 3735 | VXGE_HW_KDFC_TRPL_FIFO_0_CTRL_SELECT(0); | 
|  | 3736 |  | 
|  | 3737 | writeq(val64, &vp_reg->kdfc_trpl_fifo_0_ctrl); | 
|  | 3738 | writeq((u64)0, &vp_reg->kdfc_trpl_fifo_0_wb_address); | 
|  | 3739 | wmb(); | 
|  | 3740 | vpath_stride = readq(&hldev->toc_reg->toc_kdfc_vpath_stride); | 
|  | 3741 |  | 
|  | 3742 | vpath->nofl_db = | 
|  | 3743 | (struct __vxge_hw_non_offload_db_wrapper __iomem *) | 
|  | 3744 | (hldev->kdfc + (vp_id * | 
|  | 3745 | VXGE_HW_TOC_KDFC_VPATH_STRIDE_GET_TOC_KDFC_VPATH_STRIDE( | 
|  | 3746 | vpath_stride))); | 
|  | 3747 | exit: | 
|  | 3748 | return status; | 
|  | 3749 | } | 
|  | 3750 |  | 
|  | 3751 | /* | 
|  | 3752 | * __vxge_hw_vpath_mac_configure | 
|  | 3753 | * This routine configures the mac of virtual path using the config passed | 
|  | 3754 | */ | 
|  | 3755 | enum vxge_hw_status | 
|  | 3756 | __vxge_hw_vpath_mac_configure(struct __vxge_hw_device *hldev, u32 vp_id) | 
|  | 3757 | { | 
|  | 3758 | u64 val64; | 
|  | 3759 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 3760 | struct __vxge_hw_virtualpath *vpath; | 
|  | 3761 | struct vxge_hw_vp_config *vp_config; | 
|  | 3762 | struct vxge_hw_vpath_reg __iomem *vp_reg; | 
|  | 3763 |  | 
|  | 3764 | vpath = &hldev->virtual_paths[vp_id]; | 
|  | 3765 | vp_reg = vpath->vp_reg; | 
|  | 3766 | vp_config = vpath->vp_config; | 
|  | 3767 |  | 
|  | 3768 | writeq(VXGE_HW_XMAC_VSPORT_CHOICE_VSPORT_NUMBER( | 
|  | 3769 | vpath->vsport_number), &vp_reg->xmac_vsport_choice); | 
|  | 3770 |  | 
|  | 3771 | if (vp_config->ring.enable == VXGE_HW_RING_ENABLE) { | 
|  | 3772 |  | 
|  | 3773 | val64 = readq(&vp_reg->xmac_rpa_vcfg); | 
|  | 3774 |  | 
|  | 3775 | if (vp_config->rpa_strip_vlan_tag != | 
|  | 3776 | VXGE_HW_VPATH_RPA_STRIP_VLAN_TAG_USE_FLASH_DEFAULT) { | 
|  | 3777 | if (vp_config->rpa_strip_vlan_tag) | 
|  | 3778 | val64 |= VXGE_HW_XMAC_RPA_VCFG_STRIP_VLAN_TAG; | 
|  | 3779 | else | 
|  | 3780 | val64 &= ~VXGE_HW_XMAC_RPA_VCFG_STRIP_VLAN_TAG; | 
|  | 3781 | } | 
|  | 3782 |  | 
|  | 3783 | writeq(val64, &vp_reg->xmac_rpa_vcfg); | 
|  | 3784 | val64 = readq(&vp_reg->rxmac_vcfg0); | 
|  | 3785 |  | 
|  | 3786 | if (vp_config->mtu != | 
|  | 3787 | VXGE_HW_VPATH_USE_FLASH_DEFAULT_INITIAL_MTU) { | 
|  | 3788 | val64 &= ~VXGE_HW_RXMAC_VCFG0_RTS_MAX_FRM_LEN(0x3fff); | 
|  | 3789 | if ((vp_config->mtu  + | 
|  | 3790 | VXGE_HW_MAC_HEADER_MAX_SIZE) < vpath->max_mtu) | 
|  | 3791 | val64 |= VXGE_HW_RXMAC_VCFG0_RTS_MAX_FRM_LEN( | 
|  | 3792 | vp_config->mtu  + | 
|  | 3793 | VXGE_HW_MAC_HEADER_MAX_SIZE); | 
|  | 3794 | else | 
|  | 3795 | val64 |= VXGE_HW_RXMAC_VCFG0_RTS_MAX_FRM_LEN( | 
|  | 3796 | vpath->max_mtu); | 
|  | 3797 | } | 
|  | 3798 |  | 
|  | 3799 | writeq(val64, &vp_reg->rxmac_vcfg0); | 
|  | 3800 |  | 
|  | 3801 | val64 = readq(&vp_reg->rxmac_vcfg1); | 
|  | 3802 |  | 
|  | 3803 | val64 &= ~(VXGE_HW_RXMAC_VCFG1_RTS_RTH_MULTI_IT_BD_MODE(0x3) | | 
|  | 3804 | VXGE_HW_RXMAC_VCFG1_RTS_RTH_MULTI_IT_EN_MODE); | 
|  | 3805 |  | 
|  | 3806 | if (hldev->config.rth_it_type == | 
|  | 3807 | VXGE_HW_RTH_IT_TYPE_MULTI_IT) { | 
|  | 3808 | val64 |= VXGE_HW_RXMAC_VCFG1_RTS_RTH_MULTI_IT_BD_MODE( | 
|  | 3809 | 0x2) | | 
|  | 3810 | VXGE_HW_RXMAC_VCFG1_RTS_RTH_MULTI_IT_EN_MODE; | 
|  | 3811 | } | 
|  | 3812 |  | 
|  | 3813 | writeq(val64, &vp_reg->rxmac_vcfg1); | 
|  | 3814 | } | 
|  | 3815 | return status; | 
|  | 3816 | } | 
|  | 3817 |  | 
|  | 3818 | /* | 
|  | 3819 | * __vxge_hw_vpath_tim_configure | 
|  | 3820 | * This routine configures the tim registers of virtual path using the config | 
|  | 3821 | * passed | 
|  | 3822 | */ | 
|  | 3823 | enum vxge_hw_status | 
|  | 3824 | __vxge_hw_vpath_tim_configure(struct __vxge_hw_device *hldev, u32 vp_id) | 
|  | 3825 | { | 
|  | 3826 | u64 val64; | 
|  | 3827 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 3828 | struct __vxge_hw_virtualpath *vpath; | 
|  | 3829 | struct vxge_hw_vpath_reg __iomem *vp_reg; | 
|  | 3830 | struct vxge_hw_vp_config *config; | 
|  | 3831 |  | 
|  | 3832 | vpath = &hldev->virtual_paths[vp_id]; | 
|  | 3833 | vp_reg = vpath->vp_reg; | 
|  | 3834 | config = vpath->vp_config; | 
|  | 3835 |  | 
|  | 3836 | writeq((u64)0, &vp_reg->tim_dest_addr); | 
|  | 3837 | writeq((u64)0, &vp_reg->tim_vpath_map); | 
|  | 3838 | writeq((u64)0, &vp_reg->tim_bitmap); | 
|  | 3839 | writeq((u64)0, &vp_reg->tim_remap); | 
|  | 3840 |  | 
|  | 3841 | if (config->ring.enable == VXGE_HW_RING_ENABLE) | 
|  | 3842 | writeq(VXGE_HW_TIM_RING_ASSN_INT_NUM( | 
|  | 3843 | (vp_id * VXGE_HW_MAX_INTR_PER_VP) + | 
|  | 3844 | VXGE_HW_VPATH_INTR_RX), &vp_reg->tim_ring_assn); | 
|  | 3845 |  | 
|  | 3846 | val64 = readq(&vp_reg->tim_pci_cfg); | 
|  | 3847 | val64 |= VXGE_HW_TIM_PCI_CFG_ADD_PAD; | 
|  | 3848 | writeq(val64, &vp_reg->tim_pci_cfg); | 
|  | 3849 |  | 
|  | 3850 | if (config->fifo.enable == VXGE_HW_FIFO_ENABLE) { | 
|  | 3851 |  | 
|  | 3852 | val64 = readq(&vp_reg->tim_cfg1_int_num[VXGE_HW_VPATH_INTR_TX]); | 
|  | 3853 |  | 
|  | 3854 | if (config->tti.btimer_val != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3855 | val64 &= ~VXGE_HW_TIM_CFG1_INT_NUM_BTIMER_VAL( | 
|  | 3856 | 0x3ffffff); | 
|  | 3857 | val64 |= VXGE_HW_TIM_CFG1_INT_NUM_BTIMER_VAL( | 
|  | 3858 | config->tti.btimer_val); | 
|  | 3859 | } | 
|  | 3860 |  | 
|  | 3861 | val64 &= ~VXGE_HW_TIM_CFG1_INT_NUM_BITMP_EN; | 
|  | 3862 |  | 
|  | 3863 | if (config->tti.timer_ac_en != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3864 | if (config->tti.timer_ac_en) | 
|  | 3865 | val64 |= VXGE_HW_TIM_CFG1_INT_NUM_TIMER_AC; | 
|  | 3866 | else | 
|  | 3867 | val64 &= ~VXGE_HW_TIM_CFG1_INT_NUM_TIMER_AC; | 
|  | 3868 | } | 
|  | 3869 |  | 
|  | 3870 | if (config->tti.timer_ci_en != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3871 | if (config->tti.timer_ci_en) | 
|  | 3872 | val64 |= VXGE_HW_TIM_CFG1_INT_NUM_TIMER_CI; | 
|  | 3873 | else | 
|  | 3874 | val64 &= ~VXGE_HW_TIM_CFG1_INT_NUM_TIMER_CI; | 
|  | 3875 | } | 
|  | 3876 |  | 
|  | 3877 | if (config->tti.urange_a != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3878 | val64 &= ~VXGE_HW_TIM_CFG1_INT_NUM_URNG_A(0x3f); | 
|  | 3879 | val64 |= VXGE_HW_TIM_CFG1_INT_NUM_URNG_A( | 
|  | 3880 | config->tti.urange_a); | 
|  | 3881 | } | 
|  | 3882 |  | 
|  | 3883 | if (config->tti.urange_b != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3884 | val64 &= ~VXGE_HW_TIM_CFG1_INT_NUM_URNG_B(0x3f); | 
|  | 3885 | val64 |= VXGE_HW_TIM_CFG1_INT_NUM_URNG_B( | 
|  | 3886 | config->tti.urange_b); | 
|  | 3887 | } | 
|  | 3888 |  | 
|  | 3889 | if (config->tti.urange_c != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3890 | val64 &= ~VXGE_HW_TIM_CFG1_INT_NUM_URNG_C(0x3f); | 
|  | 3891 | val64 |= VXGE_HW_TIM_CFG1_INT_NUM_URNG_C( | 
|  | 3892 | config->tti.urange_c); | 
|  | 3893 | } | 
|  | 3894 |  | 
|  | 3895 | writeq(val64, &vp_reg->tim_cfg1_int_num[VXGE_HW_VPATH_INTR_TX]); | 
|  | 3896 | val64 = readq(&vp_reg->tim_cfg2_int_num[VXGE_HW_VPATH_INTR_TX]); | 
|  | 3897 |  | 
|  | 3898 | if (config->tti.uec_a != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3899 | val64 &= ~VXGE_HW_TIM_CFG2_INT_NUM_UEC_A(0xffff); | 
|  | 3900 | val64 |= VXGE_HW_TIM_CFG2_INT_NUM_UEC_A( | 
|  | 3901 | config->tti.uec_a); | 
|  | 3902 | } | 
|  | 3903 |  | 
|  | 3904 | if (config->tti.uec_b != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3905 | val64 &= ~VXGE_HW_TIM_CFG2_INT_NUM_UEC_B(0xffff); | 
|  | 3906 | val64 |= VXGE_HW_TIM_CFG2_INT_NUM_UEC_B( | 
|  | 3907 | config->tti.uec_b); | 
|  | 3908 | } | 
|  | 3909 |  | 
|  | 3910 | if (config->tti.uec_c != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3911 | val64 &= ~VXGE_HW_TIM_CFG2_INT_NUM_UEC_C(0xffff); | 
|  | 3912 | val64 |= VXGE_HW_TIM_CFG2_INT_NUM_UEC_C( | 
|  | 3913 | config->tti.uec_c); | 
|  | 3914 | } | 
|  | 3915 |  | 
|  | 3916 | if (config->tti.uec_d != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3917 | val64 &= ~VXGE_HW_TIM_CFG2_INT_NUM_UEC_D(0xffff); | 
|  | 3918 | val64 |= VXGE_HW_TIM_CFG2_INT_NUM_UEC_D( | 
|  | 3919 | config->tti.uec_d); | 
|  | 3920 | } | 
|  | 3921 |  | 
|  | 3922 | writeq(val64, &vp_reg->tim_cfg2_int_num[VXGE_HW_VPATH_INTR_TX]); | 
|  | 3923 | val64 = readq(&vp_reg->tim_cfg3_int_num[VXGE_HW_VPATH_INTR_TX]); | 
|  | 3924 |  | 
|  | 3925 | if (config->tti.timer_ri_en != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3926 | if (config->tti.timer_ri_en) | 
|  | 3927 | val64 |= VXGE_HW_TIM_CFG3_INT_NUM_TIMER_RI; | 
|  | 3928 | else | 
|  | 3929 | val64 &= ~VXGE_HW_TIM_CFG3_INT_NUM_TIMER_RI; | 
|  | 3930 | } | 
|  | 3931 |  | 
|  | 3932 | if (config->tti.rtimer_val != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3933 | val64 &= ~VXGE_HW_TIM_CFG3_INT_NUM_RTIMER_VAL( | 
|  | 3934 | 0x3ffffff); | 
|  | 3935 | val64 |= VXGE_HW_TIM_CFG3_INT_NUM_RTIMER_VAL( | 
|  | 3936 | config->tti.rtimer_val); | 
|  | 3937 | } | 
|  | 3938 |  | 
|  | 3939 | if (config->tti.util_sel != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3940 | val64 &= ~VXGE_HW_TIM_CFG3_INT_NUM_UTIL_SEL(0x3f); | 
|  | 3941 | val64 |= VXGE_HW_TIM_CFG3_INT_NUM_UTIL_SEL( | 
|  | 3942 | config->tti.util_sel); | 
|  | 3943 | } | 
|  | 3944 |  | 
|  | 3945 | if (config->tti.ltimer_val != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3946 | val64 &= ~VXGE_HW_TIM_CFG3_INT_NUM_LTIMER_VAL( | 
|  | 3947 | 0x3ffffff); | 
|  | 3948 | val64 |= VXGE_HW_TIM_CFG3_INT_NUM_LTIMER_VAL( | 
|  | 3949 | config->tti.ltimer_val); | 
|  | 3950 | } | 
|  | 3951 |  | 
|  | 3952 | writeq(val64, &vp_reg->tim_cfg3_int_num[VXGE_HW_VPATH_INTR_TX]); | 
|  | 3953 | } | 
|  | 3954 |  | 
|  | 3955 | if (config->ring.enable == VXGE_HW_RING_ENABLE) { | 
|  | 3956 |  | 
|  | 3957 | val64 = readq(&vp_reg->tim_cfg1_int_num[VXGE_HW_VPATH_INTR_RX]); | 
|  | 3958 |  | 
|  | 3959 | if (config->rti.btimer_val != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3960 | val64 &= ~VXGE_HW_TIM_CFG1_INT_NUM_BTIMER_VAL( | 
|  | 3961 | 0x3ffffff); | 
|  | 3962 | val64 |= VXGE_HW_TIM_CFG1_INT_NUM_BTIMER_VAL( | 
|  | 3963 | config->rti.btimer_val); | 
|  | 3964 | } | 
|  | 3965 |  | 
|  | 3966 | val64 &= ~VXGE_HW_TIM_CFG1_INT_NUM_BITMP_EN; | 
|  | 3967 |  | 
|  | 3968 | if (config->rti.timer_ac_en != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3969 | if (config->rti.timer_ac_en) | 
|  | 3970 | val64 |= VXGE_HW_TIM_CFG1_INT_NUM_TIMER_AC; | 
|  | 3971 | else | 
|  | 3972 | val64 &= ~VXGE_HW_TIM_CFG1_INT_NUM_TIMER_AC; | 
|  | 3973 | } | 
|  | 3974 |  | 
|  | 3975 | if (config->rti.timer_ci_en != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3976 | if (config->rti.timer_ci_en) | 
|  | 3977 | val64 |= VXGE_HW_TIM_CFG1_INT_NUM_TIMER_CI; | 
|  | 3978 | else | 
|  | 3979 | val64 &= ~VXGE_HW_TIM_CFG1_INT_NUM_TIMER_CI; | 
|  | 3980 | } | 
|  | 3981 |  | 
|  | 3982 | if (config->rti.urange_a != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3983 | val64 &= ~VXGE_HW_TIM_CFG1_INT_NUM_URNG_A(0x3f); | 
|  | 3984 | val64 |= VXGE_HW_TIM_CFG1_INT_NUM_URNG_A( | 
|  | 3985 | config->rti.urange_a); | 
|  | 3986 | } | 
|  | 3987 |  | 
|  | 3988 | if (config->rti.urange_b != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3989 | val64 &= ~VXGE_HW_TIM_CFG1_INT_NUM_URNG_B(0x3f); | 
|  | 3990 | val64 |= VXGE_HW_TIM_CFG1_INT_NUM_URNG_B( | 
|  | 3991 | config->rti.urange_b); | 
|  | 3992 | } | 
|  | 3993 |  | 
|  | 3994 | if (config->rti.urange_c != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 3995 | val64 &= ~VXGE_HW_TIM_CFG1_INT_NUM_URNG_C(0x3f); | 
|  | 3996 | val64 |= VXGE_HW_TIM_CFG1_INT_NUM_URNG_C( | 
|  | 3997 | config->rti.urange_c); | 
|  | 3998 | } | 
|  | 3999 |  | 
|  | 4000 | writeq(val64, &vp_reg->tim_cfg1_int_num[VXGE_HW_VPATH_INTR_RX]); | 
|  | 4001 | val64 = readq(&vp_reg->tim_cfg2_int_num[VXGE_HW_VPATH_INTR_RX]); | 
|  | 4002 |  | 
|  | 4003 | if (config->rti.uec_a != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 4004 | val64 &= ~VXGE_HW_TIM_CFG2_INT_NUM_UEC_A(0xffff); | 
|  | 4005 | val64 |= VXGE_HW_TIM_CFG2_INT_NUM_UEC_A( | 
|  | 4006 | config->rti.uec_a); | 
|  | 4007 | } | 
|  | 4008 |  | 
|  | 4009 | if (config->rti.uec_b != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 4010 | val64 &= ~VXGE_HW_TIM_CFG2_INT_NUM_UEC_B(0xffff); | 
|  | 4011 | val64 |= VXGE_HW_TIM_CFG2_INT_NUM_UEC_B( | 
|  | 4012 | config->rti.uec_b); | 
|  | 4013 | } | 
|  | 4014 |  | 
|  | 4015 | if (config->rti.uec_c != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 4016 | val64 &= ~VXGE_HW_TIM_CFG2_INT_NUM_UEC_C(0xffff); | 
|  | 4017 | val64 |= VXGE_HW_TIM_CFG2_INT_NUM_UEC_C( | 
|  | 4018 | config->rti.uec_c); | 
|  | 4019 | } | 
|  | 4020 |  | 
|  | 4021 | if (config->rti.uec_d != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 4022 | val64 &= ~VXGE_HW_TIM_CFG2_INT_NUM_UEC_D(0xffff); | 
|  | 4023 | val64 |= VXGE_HW_TIM_CFG2_INT_NUM_UEC_D( | 
|  | 4024 | config->rti.uec_d); | 
|  | 4025 | } | 
|  | 4026 |  | 
|  | 4027 | writeq(val64, &vp_reg->tim_cfg2_int_num[VXGE_HW_VPATH_INTR_RX]); | 
|  | 4028 | val64 = readq(&vp_reg->tim_cfg3_int_num[VXGE_HW_VPATH_INTR_RX]); | 
|  | 4029 |  | 
|  | 4030 | if (config->rti.timer_ri_en != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 4031 | if (config->rti.timer_ri_en) | 
|  | 4032 | val64 |= VXGE_HW_TIM_CFG3_INT_NUM_TIMER_RI; | 
|  | 4033 | else | 
|  | 4034 | val64 &= ~VXGE_HW_TIM_CFG3_INT_NUM_TIMER_RI; | 
|  | 4035 | } | 
|  | 4036 |  | 
|  | 4037 | if (config->rti.rtimer_val != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 4038 | val64 &= ~VXGE_HW_TIM_CFG3_INT_NUM_RTIMER_VAL( | 
|  | 4039 | 0x3ffffff); | 
|  | 4040 | val64 |= VXGE_HW_TIM_CFG3_INT_NUM_RTIMER_VAL( | 
|  | 4041 | config->rti.rtimer_val); | 
|  | 4042 | } | 
|  | 4043 |  | 
|  | 4044 | if (config->rti.util_sel != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 4045 | val64 &= ~VXGE_HW_TIM_CFG3_INT_NUM_UTIL_SEL(0x3f); | 
|  | 4046 | val64 |= VXGE_HW_TIM_CFG3_INT_NUM_UTIL_SEL( | 
|  | 4047 | config->rti.util_sel); | 
|  | 4048 | } | 
|  | 4049 |  | 
|  | 4050 | if (config->rti.ltimer_val != VXGE_HW_USE_FLASH_DEFAULT) { | 
|  | 4051 | val64 &= ~VXGE_HW_TIM_CFG3_INT_NUM_LTIMER_VAL( | 
|  | 4052 | 0x3ffffff); | 
|  | 4053 | val64 |= VXGE_HW_TIM_CFG3_INT_NUM_LTIMER_VAL( | 
|  | 4054 | config->rti.ltimer_val); | 
|  | 4055 | } | 
|  | 4056 |  | 
|  | 4057 | writeq(val64, &vp_reg->tim_cfg3_int_num[VXGE_HW_VPATH_INTR_RX]); | 
|  | 4058 | } | 
|  | 4059 |  | 
|  | 4060 | val64 = 0; | 
|  | 4061 | writeq(val64, &vp_reg->tim_cfg1_int_num[VXGE_HW_VPATH_INTR_EINTA]); | 
|  | 4062 | writeq(val64, &vp_reg->tim_cfg2_int_num[VXGE_HW_VPATH_INTR_EINTA]); | 
|  | 4063 | writeq(val64, &vp_reg->tim_cfg3_int_num[VXGE_HW_VPATH_INTR_EINTA]); | 
|  | 4064 | writeq(val64, &vp_reg->tim_cfg1_int_num[VXGE_HW_VPATH_INTR_BMAP]); | 
|  | 4065 | writeq(val64, &vp_reg->tim_cfg2_int_num[VXGE_HW_VPATH_INTR_BMAP]); | 
|  | 4066 | writeq(val64, &vp_reg->tim_cfg3_int_num[VXGE_HW_VPATH_INTR_BMAP]); | 
|  | 4067 |  | 
|  | 4068 | return status; | 
|  | 4069 | } | 
|  | 4070 |  | 
|  | 4071 | /* | 
|  | 4072 | * __vxge_hw_vpath_initialize | 
|  | 4073 | * This routine is the final phase of init which initializes the | 
|  | 4074 | * registers of the vpath using the configuration passed. | 
|  | 4075 | */ | 
|  | 4076 | enum vxge_hw_status | 
|  | 4077 | __vxge_hw_vpath_initialize(struct __vxge_hw_device *hldev, u32 vp_id) | 
|  | 4078 | { | 
|  | 4079 | u64 val64; | 
|  | 4080 | u32 val32; | 
|  | 4081 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 4082 | struct __vxge_hw_virtualpath *vpath; | 
|  | 4083 | struct vxge_hw_vpath_reg __iomem *vp_reg; | 
|  | 4084 |  | 
|  | 4085 | vpath = &hldev->virtual_paths[vp_id]; | 
|  | 4086 |  | 
|  | 4087 | if (!(hldev->vpath_assignments & vxge_mBIT(vp_id))) { | 
|  | 4088 | status = VXGE_HW_ERR_VPATH_NOT_AVAILABLE; | 
|  | 4089 | goto exit; | 
|  | 4090 | } | 
|  | 4091 | vp_reg = vpath->vp_reg; | 
|  | 4092 |  | 
|  | 4093 | status =  __vxge_hw_vpath_swapper_set(vpath->vp_reg); | 
|  | 4094 |  | 
|  | 4095 | if (status != VXGE_HW_OK) | 
|  | 4096 | goto exit; | 
|  | 4097 |  | 
|  | 4098 | status =  __vxge_hw_vpath_mac_configure(hldev, vp_id); | 
|  | 4099 |  | 
|  | 4100 | if (status != VXGE_HW_OK) | 
|  | 4101 | goto exit; | 
|  | 4102 |  | 
|  | 4103 | status =  __vxge_hw_vpath_kdfc_configure(hldev, vp_id); | 
|  | 4104 |  | 
|  | 4105 | if (status != VXGE_HW_OK) | 
|  | 4106 | goto exit; | 
|  | 4107 |  | 
|  | 4108 | status = __vxge_hw_vpath_tim_configure(hldev, vp_id); | 
|  | 4109 |  | 
|  | 4110 | if (status != VXGE_HW_OK) | 
|  | 4111 | goto exit; | 
|  | 4112 |  | 
|  | 4113 | writeq(0, &vp_reg->gendma_int); | 
|  | 4114 |  | 
|  | 4115 | val64 = readq(&vp_reg->rtdma_rd_optimization_ctrl); | 
|  | 4116 |  | 
|  | 4117 | /* Get MRRS value from device control */ | 
|  | 4118 | status  = __vxge_hw_vpath_pci_read(vpath, 1, 0x78, &val32); | 
|  | 4119 |  | 
|  | 4120 | if (status == VXGE_HW_OK) { | 
|  | 4121 | val32 = (val32 & VXGE_HW_PCI_EXP_DEVCTL_READRQ) >> 12; | 
|  | 4122 | val64 &= | 
|  | 4123 | ~(VXGE_HW_RTDMA_RD_OPTIMIZATION_CTRL_FB_FILL_THRESH(7)); | 
|  | 4124 | val64 |= | 
|  | 4125 | VXGE_HW_RTDMA_RD_OPTIMIZATION_CTRL_FB_FILL_THRESH(val32); | 
|  | 4126 |  | 
|  | 4127 | val64 |= VXGE_HW_RTDMA_RD_OPTIMIZATION_CTRL_FB_WAIT_FOR_SPACE; | 
|  | 4128 | } | 
|  | 4129 |  | 
|  | 4130 | val64 &= ~(VXGE_HW_RTDMA_RD_OPTIMIZATION_CTRL_FB_ADDR_BDRY(7)); | 
|  | 4131 | val64 |= | 
|  | 4132 | VXGE_HW_RTDMA_RD_OPTIMIZATION_CTRL_FB_ADDR_BDRY( | 
|  | 4133 | VXGE_HW_MAX_PAYLOAD_SIZE_512); | 
|  | 4134 |  | 
|  | 4135 | val64 |= VXGE_HW_RTDMA_RD_OPTIMIZATION_CTRL_FB_ADDR_BDRY_EN; | 
|  | 4136 | writeq(val64, &vp_reg->rtdma_rd_optimization_ctrl); | 
|  | 4137 |  | 
|  | 4138 | exit: | 
|  | 4139 | return status; | 
|  | 4140 | } | 
|  | 4141 |  | 
|  | 4142 | /* | 
|  | 4143 | * __vxge_hw_vp_initialize - Initialize Virtual Path structure | 
|  | 4144 | * This routine is the initial phase of init which resets the vpath and | 
|  | 4145 | * initializes the software support structures. | 
|  | 4146 | */ | 
|  | 4147 | enum vxge_hw_status | 
|  | 4148 | __vxge_hw_vp_initialize(struct __vxge_hw_device *hldev, u32 vp_id, | 
|  | 4149 | struct vxge_hw_vp_config *config) | 
|  | 4150 | { | 
|  | 4151 | struct __vxge_hw_virtualpath *vpath; | 
|  | 4152 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 4153 |  | 
|  | 4154 | if (!(hldev->vpath_assignments & vxge_mBIT(vp_id))) { | 
|  | 4155 | status = VXGE_HW_ERR_VPATH_NOT_AVAILABLE; | 
|  | 4156 | goto exit; | 
|  | 4157 | } | 
|  | 4158 |  | 
|  | 4159 | vpath = &hldev->virtual_paths[vp_id]; | 
|  | 4160 |  | 
|  | 4161 | vpath->vp_id = vp_id; | 
|  | 4162 | vpath->vp_open = VXGE_HW_VP_OPEN; | 
|  | 4163 | vpath->hldev = hldev; | 
|  | 4164 | vpath->vp_config = config; | 
|  | 4165 | vpath->vp_reg = hldev->vpath_reg[vp_id]; | 
|  | 4166 | vpath->vpmgmt_reg = hldev->vpmgmt_reg[vp_id]; | 
|  | 4167 |  | 
|  | 4168 | __vxge_hw_vpath_reset(hldev, vp_id); | 
|  | 4169 |  | 
|  | 4170 | status = __vxge_hw_vpath_reset_check(vpath); | 
|  | 4171 |  | 
|  | 4172 | if (status != VXGE_HW_OK) { | 
|  | 4173 | memset(vpath, 0, sizeof(struct __vxge_hw_virtualpath)); | 
|  | 4174 | goto exit; | 
|  | 4175 | } | 
|  | 4176 |  | 
|  | 4177 | status = __vxge_hw_vpath_mgmt_read(hldev, vpath); | 
|  | 4178 |  | 
|  | 4179 | if (status != VXGE_HW_OK) { | 
|  | 4180 | memset(vpath, 0, sizeof(struct __vxge_hw_virtualpath)); | 
|  | 4181 | goto exit; | 
|  | 4182 | } | 
|  | 4183 |  | 
|  | 4184 | INIT_LIST_HEAD(&vpath->vpath_handles); | 
|  | 4185 |  | 
|  | 4186 | vpath->sw_stats = &hldev->stats.sw_dev_info_stats.vpath_info[vp_id]; | 
|  | 4187 |  | 
|  | 4188 | VXGE_HW_DEVICE_TIM_INT_MASK_SET(hldev->tim_int_mask0, | 
|  | 4189 | hldev->tim_int_mask1, vp_id); | 
|  | 4190 |  | 
|  | 4191 | status = __vxge_hw_vpath_initialize(hldev, vp_id); | 
|  | 4192 |  | 
|  | 4193 | if (status != VXGE_HW_OK) | 
|  | 4194 | __vxge_hw_vp_terminate(hldev, vp_id); | 
|  | 4195 | exit: | 
|  | 4196 | return status; | 
|  | 4197 | } | 
|  | 4198 |  | 
|  | 4199 | /* | 
|  | 4200 | * __vxge_hw_vp_terminate - Terminate Virtual Path structure | 
|  | 4201 | * This routine closes all channels it opened and freeup memory | 
|  | 4202 | */ | 
|  | 4203 | void | 
|  | 4204 | __vxge_hw_vp_terminate(struct __vxge_hw_device *hldev, u32 vp_id) | 
|  | 4205 | { | 
|  | 4206 | struct __vxge_hw_virtualpath *vpath; | 
|  | 4207 |  | 
|  | 4208 | vpath = &hldev->virtual_paths[vp_id]; | 
|  | 4209 |  | 
|  | 4210 | if (vpath->vp_open == VXGE_HW_VP_NOT_OPEN) | 
|  | 4211 | goto exit; | 
|  | 4212 |  | 
|  | 4213 | VXGE_HW_DEVICE_TIM_INT_MASK_RESET(vpath->hldev->tim_int_mask0, | 
|  | 4214 | vpath->hldev->tim_int_mask1, vpath->vp_id); | 
|  | 4215 | hldev->stats.hw_dev_info_stats.vpath_info[vpath->vp_id] = NULL; | 
|  | 4216 |  | 
|  | 4217 | memset(vpath, 0, sizeof(struct __vxge_hw_virtualpath)); | 
|  | 4218 | exit: | 
|  | 4219 | return; | 
|  | 4220 | } | 
|  | 4221 |  | 
|  | 4222 | /* | 
|  | 4223 | * vxge_hw_vpath_mtu_set - Set MTU. | 
|  | 4224 | * Set new MTU value. Example, to use jumbo frames: | 
|  | 4225 | * vxge_hw_vpath_mtu_set(my_device, 9600); | 
|  | 4226 | */ | 
|  | 4227 | enum vxge_hw_status | 
|  | 4228 | vxge_hw_vpath_mtu_set(struct __vxge_hw_vpath_handle *vp, u32 new_mtu) | 
|  | 4229 | { | 
|  | 4230 | u64 val64; | 
|  | 4231 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 4232 | struct __vxge_hw_virtualpath *vpath; | 
|  | 4233 |  | 
|  | 4234 | if (vp == NULL) { | 
|  | 4235 | status = VXGE_HW_ERR_INVALID_HANDLE; | 
|  | 4236 | goto exit; | 
|  | 4237 | } | 
|  | 4238 | vpath = vp->vpath; | 
|  | 4239 |  | 
|  | 4240 | new_mtu += VXGE_HW_MAC_HEADER_MAX_SIZE; | 
|  | 4241 |  | 
|  | 4242 | if ((new_mtu < VXGE_HW_MIN_MTU) || (new_mtu > vpath->max_mtu)) | 
|  | 4243 | status = VXGE_HW_ERR_INVALID_MTU_SIZE; | 
|  | 4244 |  | 
|  | 4245 | val64 = readq(&vpath->vp_reg->rxmac_vcfg0); | 
|  | 4246 |  | 
|  | 4247 | val64 &= ~VXGE_HW_RXMAC_VCFG0_RTS_MAX_FRM_LEN(0x3fff); | 
|  | 4248 | val64 |= VXGE_HW_RXMAC_VCFG0_RTS_MAX_FRM_LEN(new_mtu); | 
|  | 4249 |  | 
|  | 4250 | writeq(val64, &vpath->vp_reg->rxmac_vcfg0); | 
|  | 4251 |  | 
|  | 4252 | vpath->vp_config->mtu = new_mtu - VXGE_HW_MAC_HEADER_MAX_SIZE; | 
|  | 4253 |  | 
|  | 4254 | exit: | 
|  | 4255 | return status; | 
|  | 4256 | } | 
|  | 4257 |  | 
|  | 4258 | /* | 
|  | 4259 | * vxge_hw_vpath_open - Open a virtual path on a given adapter | 
|  | 4260 | * This function is used to open access to virtual path of an | 
|  | 4261 | * adapter for offload, GRO operations. This function returns | 
|  | 4262 | * synchronously. | 
|  | 4263 | */ | 
|  | 4264 | enum vxge_hw_status | 
|  | 4265 | vxge_hw_vpath_open(struct __vxge_hw_device *hldev, | 
|  | 4266 | struct vxge_hw_vpath_attr *attr, | 
|  | 4267 | struct __vxge_hw_vpath_handle **vpath_handle) | 
|  | 4268 | { | 
|  | 4269 | struct __vxge_hw_virtualpath *vpath; | 
|  | 4270 | struct __vxge_hw_vpath_handle *vp; | 
|  | 4271 | enum vxge_hw_status status; | 
|  | 4272 |  | 
|  | 4273 | vpath = &hldev->virtual_paths[attr->vp_id]; | 
|  | 4274 |  | 
|  | 4275 | if (vpath->vp_open == VXGE_HW_VP_OPEN) { | 
|  | 4276 | status = VXGE_HW_ERR_INVALID_STATE; | 
|  | 4277 | goto vpath_open_exit1; | 
|  | 4278 | } | 
|  | 4279 |  | 
|  | 4280 | status = __vxge_hw_vp_initialize(hldev, attr->vp_id, | 
|  | 4281 | &hldev->config.vp_config[attr->vp_id]); | 
|  | 4282 |  | 
|  | 4283 | if (status != VXGE_HW_OK) | 
|  | 4284 | goto vpath_open_exit1; | 
|  | 4285 |  | 
|  | 4286 | vp = (struct __vxge_hw_vpath_handle *) | 
|  | 4287 | vmalloc(sizeof(struct __vxge_hw_vpath_handle)); | 
|  | 4288 | if (vp == NULL) { | 
|  | 4289 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 4290 | goto vpath_open_exit2; | 
|  | 4291 | } | 
|  | 4292 |  | 
|  | 4293 | memset(vp, 0, sizeof(struct __vxge_hw_vpath_handle)); | 
|  | 4294 |  | 
|  | 4295 | vp->vpath = vpath; | 
|  | 4296 |  | 
|  | 4297 | if (vpath->vp_config->fifo.enable == VXGE_HW_FIFO_ENABLE) { | 
|  | 4298 | status = __vxge_hw_fifo_create(vp, &attr->fifo_attr); | 
|  | 4299 | if (status != VXGE_HW_OK) | 
|  | 4300 | goto vpath_open_exit6; | 
|  | 4301 | } | 
|  | 4302 |  | 
|  | 4303 | if (vpath->vp_config->ring.enable == VXGE_HW_RING_ENABLE) { | 
|  | 4304 | status = __vxge_hw_ring_create(vp, &attr->ring_attr); | 
|  | 4305 | if (status != VXGE_HW_OK) | 
|  | 4306 | goto vpath_open_exit7; | 
|  | 4307 |  | 
|  | 4308 | __vxge_hw_vpath_prc_configure(hldev, attr->vp_id); | 
|  | 4309 | } | 
|  | 4310 |  | 
|  | 4311 | vpath->fifoh->tx_intr_num = | 
|  | 4312 | (attr->vp_id * VXGE_HW_MAX_INTR_PER_VP)  + | 
|  | 4313 | VXGE_HW_VPATH_INTR_TX; | 
|  | 4314 |  | 
|  | 4315 | vpath->stats_block = __vxge_hw_blockpool_block_allocate(hldev, | 
|  | 4316 | VXGE_HW_BLOCK_SIZE); | 
|  | 4317 |  | 
|  | 4318 | if (vpath->stats_block == NULL) { | 
|  | 4319 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 4320 | goto vpath_open_exit8; | 
|  | 4321 | } | 
|  | 4322 |  | 
|  | 4323 | vpath->hw_stats = (struct vxge_hw_vpath_stats_hw_info *)vpath-> | 
|  | 4324 | stats_block->memblock; | 
|  | 4325 | memset(vpath->hw_stats, 0, | 
|  | 4326 | sizeof(struct vxge_hw_vpath_stats_hw_info)); | 
|  | 4327 |  | 
|  | 4328 | hldev->stats.hw_dev_info_stats.vpath_info[attr->vp_id] = | 
|  | 4329 | vpath->hw_stats; | 
|  | 4330 |  | 
|  | 4331 | vpath->hw_stats_sav = | 
|  | 4332 | &hldev->stats.hw_dev_info_stats.vpath_info_sav[attr->vp_id]; | 
|  | 4333 | memset(vpath->hw_stats_sav, 0, | 
|  | 4334 | sizeof(struct vxge_hw_vpath_stats_hw_info)); | 
|  | 4335 |  | 
|  | 4336 | writeq(vpath->stats_block->dma_addr, &vpath->vp_reg->stats_cfg); | 
|  | 4337 |  | 
|  | 4338 | status = vxge_hw_vpath_stats_enable(vp); | 
|  | 4339 | if (status != VXGE_HW_OK) | 
|  | 4340 | goto vpath_open_exit8; | 
|  | 4341 |  | 
|  | 4342 | list_add(&vp->item, &vpath->vpath_handles); | 
|  | 4343 |  | 
|  | 4344 | hldev->vpaths_deployed |= vxge_mBIT(vpath->vp_id); | 
|  | 4345 |  | 
|  | 4346 | *vpath_handle = vp; | 
|  | 4347 |  | 
|  | 4348 | attr->fifo_attr.userdata = vpath->fifoh; | 
|  | 4349 | attr->ring_attr.userdata = vpath->ringh; | 
|  | 4350 |  | 
|  | 4351 | return VXGE_HW_OK; | 
|  | 4352 |  | 
|  | 4353 | vpath_open_exit8: | 
|  | 4354 | if (vpath->ringh != NULL) | 
|  | 4355 | __vxge_hw_ring_delete(vp); | 
|  | 4356 | vpath_open_exit7: | 
|  | 4357 | if (vpath->fifoh != NULL) | 
|  | 4358 | __vxge_hw_fifo_delete(vp); | 
|  | 4359 | vpath_open_exit6: | 
|  | 4360 | vfree(vp); | 
|  | 4361 | vpath_open_exit2: | 
|  | 4362 | __vxge_hw_vp_terminate(hldev, attr->vp_id); | 
|  | 4363 | vpath_open_exit1: | 
|  | 4364 |  | 
|  | 4365 | return status; | 
|  | 4366 | } | 
|  | 4367 |  | 
|  | 4368 | /** | 
|  | 4369 | * vxge_hw_vpath_rx_doorbell_post - Close the handle got from previous vpath | 
|  | 4370 | * (vpath) open | 
|  | 4371 | * @vp: Handle got from previous vpath open | 
|  | 4372 | * | 
|  | 4373 | * This function is used to close access to virtual path opened | 
|  | 4374 | * earlier. | 
|  | 4375 | */ | 
|  | 4376 | void | 
|  | 4377 | vxge_hw_vpath_rx_doorbell_init(struct __vxge_hw_vpath_handle *vp) | 
|  | 4378 | { | 
|  | 4379 | struct __vxge_hw_virtualpath *vpath = NULL; | 
|  | 4380 | u64 new_count, val64, val164; | 
|  | 4381 | struct __vxge_hw_ring *ring; | 
|  | 4382 |  | 
|  | 4383 | vpath = vp->vpath; | 
|  | 4384 | ring = vpath->ringh; | 
|  | 4385 |  | 
|  | 4386 | new_count = readq(&vpath->vp_reg->rxdmem_size); | 
|  | 4387 | new_count &= 0x1fff; | 
|  | 4388 | val164 = (VXGE_HW_RXDMEM_SIZE_PRC_RXDMEM_SIZE(new_count)); | 
|  | 4389 |  | 
|  | 4390 | writeq(VXGE_HW_PRC_RXD_DOORBELL_NEW_QW_CNT(val164), | 
|  | 4391 | &vpath->vp_reg->prc_rxd_doorbell); | 
|  | 4392 | readl(&vpath->vp_reg->prc_rxd_doorbell); | 
|  | 4393 |  | 
|  | 4394 | val164 /= 2; | 
|  | 4395 | val64 = readq(&vpath->vp_reg->prc_cfg6); | 
|  | 4396 | val64 = VXGE_HW_PRC_CFG6_RXD_SPAT(val64); | 
|  | 4397 | val64 &= 0x1ff; | 
|  | 4398 |  | 
|  | 4399 | /* | 
|  | 4400 | * Each RxD is of 4 qwords | 
|  | 4401 | */ | 
|  | 4402 | new_count -= (val64 + 1); | 
|  | 4403 | val64 = min(val164, new_count) / 4; | 
|  | 4404 |  | 
|  | 4405 | ring->rxds_limit = min(ring->rxds_limit, val64); | 
|  | 4406 | if (ring->rxds_limit < 4) | 
|  | 4407 | ring->rxds_limit = 4; | 
|  | 4408 | } | 
|  | 4409 |  | 
|  | 4410 | /* | 
|  | 4411 | * vxge_hw_vpath_close - Close the handle got from previous vpath (vpath) open | 
|  | 4412 | * This function is used to close access to virtual path opened | 
|  | 4413 | * earlier. | 
|  | 4414 | */ | 
|  | 4415 | enum vxge_hw_status vxge_hw_vpath_close(struct __vxge_hw_vpath_handle *vp) | 
|  | 4416 | { | 
|  | 4417 | struct __vxge_hw_virtualpath *vpath = NULL; | 
|  | 4418 | struct __vxge_hw_device *devh = NULL; | 
|  | 4419 | u32 vp_id = vp->vpath->vp_id; | 
|  | 4420 | u32 is_empty = TRUE; | 
|  | 4421 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 4422 |  | 
|  | 4423 | vpath = vp->vpath; | 
|  | 4424 | devh = vpath->hldev; | 
|  | 4425 |  | 
|  | 4426 | if (vpath->vp_open == VXGE_HW_VP_NOT_OPEN) { | 
|  | 4427 | status = VXGE_HW_ERR_VPATH_NOT_OPEN; | 
|  | 4428 | goto vpath_close_exit; | 
|  | 4429 | } | 
|  | 4430 |  | 
|  | 4431 | list_del(&vp->item); | 
|  | 4432 |  | 
|  | 4433 | if (!list_empty(&vpath->vpath_handles)) { | 
|  | 4434 | list_add(&vp->item, &vpath->vpath_handles); | 
|  | 4435 | is_empty = FALSE; | 
|  | 4436 | } | 
|  | 4437 |  | 
|  | 4438 | if (!is_empty) { | 
|  | 4439 | status = VXGE_HW_FAIL; | 
|  | 4440 | goto vpath_close_exit; | 
|  | 4441 | } | 
|  | 4442 |  | 
|  | 4443 | devh->vpaths_deployed &= ~vxge_mBIT(vp_id); | 
|  | 4444 |  | 
|  | 4445 | if (vpath->ringh != NULL) | 
|  | 4446 | __vxge_hw_ring_delete(vp); | 
|  | 4447 |  | 
|  | 4448 | if (vpath->fifoh != NULL) | 
|  | 4449 | __vxge_hw_fifo_delete(vp); | 
|  | 4450 |  | 
|  | 4451 | if (vpath->stats_block != NULL) | 
|  | 4452 | __vxge_hw_blockpool_block_free(devh, vpath->stats_block); | 
|  | 4453 |  | 
|  | 4454 | vfree(vp); | 
|  | 4455 |  | 
|  | 4456 | __vxge_hw_vp_terminate(devh, vp_id); | 
|  | 4457 |  | 
|  | 4458 | vpath->vp_open = VXGE_HW_VP_NOT_OPEN; | 
|  | 4459 |  | 
|  | 4460 | vpath_close_exit: | 
|  | 4461 | return status; | 
|  | 4462 | } | 
|  | 4463 |  | 
|  | 4464 | /* | 
|  | 4465 | * vxge_hw_vpath_reset - Resets vpath | 
|  | 4466 | * This function is used to request a reset of vpath | 
|  | 4467 | */ | 
|  | 4468 | enum vxge_hw_status vxge_hw_vpath_reset(struct __vxge_hw_vpath_handle *vp) | 
|  | 4469 | { | 
|  | 4470 | enum vxge_hw_status status; | 
|  | 4471 | u32 vp_id; | 
|  | 4472 | struct __vxge_hw_virtualpath *vpath = vp->vpath; | 
|  | 4473 |  | 
|  | 4474 | vp_id = vpath->vp_id; | 
|  | 4475 |  | 
|  | 4476 | if (vpath->vp_open == VXGE_HW_VP_NOT_OPEN) { | 
|  | 4477 | status = VXGE_HW_ERR_VPATH_NOT_OPEN; | 
|  | 4478 | goto exit; | 
|  | 4479 | } | 
|  | 4480 |  | 
|  | 4481 | status = __vxge_hw_vpath_reset(vpath->hldev, vp_id); | 
|  | 4482 | if (status == VXGE_HW_OK) | 
|  | 4483 | vpath->sw_stats->soft_reset_cnt++; | 
|  | 4484 | exit: | 
|  | 4485 | return status; | 
|  | 4486 | } | 
|  | 4487 |  | 
|  | 4488 | /* | 
|  | 4489 | * vxge_hw_vpath_recover_from_reset - Poll for reset complete and re-initialize. | 
|  | 4490 | * This function poll's for the vpath reset completion and re initializes | 
|  | 4491 | * the vpath. | 
|  | 4492 | */ | 
|  | 4493 | enum vxge_hw_status | 
|  | 4494 | vxge_hw_vpath_recover_from_reset(struct __vxge_hw_vpath_handle *vp) | 
|  | 4495 | { | 
|  | 4496 | struct __vxge_hw_virtualpath *vpath = NULL; | 
|  | 4497 | enum vxge_hw_status status; | 
|  | 4498 | struct __vxge_hw_device *hldev; | 
|  | 4499 | u32 vp_id; | 
|  | 4500 |  | 
|  | 4501 | vp_id = vp->vpath->vp_id; | 
|  | 4502 | vpath = vp->vpath; | 
|  | 4503 | hldev = vpath->hldev; | 
|  | 4504 |  | 
|  | 4505 | if (vpath->vp_open == VXGE_HW_VP_NOT_OPEN) { | 
|  | 4506 | status = VXGE_HW_ERR_VPATH_NOT_OPEN; | 
|  | 4507 | goto exit; | 
|  | 4508 | } | 
|  | 4509 |  | 
|  | 4510 | status = __vxge_hw_vpath_reset_check(vpath); | 
|  | 4511 | if (status != VXGE_HW_OK) | 
|  | 4512 | goto exit; | 
|  | 4513 |  | 
|  | 4514 | status = __vxge_hw_vpath_sw_reset(hldev, vp_id); | 
|  | 4515 | if (status != VXGE_HW_OK) | 
|  | 4516 | goto exit; | 
|  | 4517 |  | 
|  | 4518 | status = __vxge_hw_vpath_initialize(hldev, vp_id); | 
|  | 4519 | if (status != VXGE_HW_OK) | 
|  | 4520 | goto exit; | 
|  | 4521 |  | 
|  | 4522 | if (vpath->ringh != NULL) | 
|  | 4523 | __vxge_hw_vpath_prc_configure(hldev, vp_id); | 
|  | 4524 |  | 
|  | 4525 | memset(vpath->hw_stats, 0, | 
|  | 4526 | sizeof(struct vxge_hw_vpath_stats_hw_info)); | 
|  | 4527 |  | 
|  | 4528 | memset(vpath->hw_stats_sav, 0, | 
|  | 4529 | sizeof(struct vxge_hw_vpath_stats_hw_info)); | 
|  | 4530 |  | 
|  | 4531 | writeq(vpath->stats_block->dma_addr, | 
|  | 4532 | &vpath->vp_reg->stats_cfg); | 
|  | 4533 |  | 
|  | 4534 | status = vxge_hw_vpath_stats_enable(vp); | 
|  | 4535 |  | 
|  | 4536 | exit: | 
|  | 4537 | return status; | 
|  | 4538 | } | 
|  | 4539 |  | 
|  | 4540 | /* | 
|  | 4541 | * vxge_hw_vpath_enable - Enable vpath. | 
|  | 4542 | * This routine clears the vpath reset thereby enabling a vpath | 
|  | 4543 | * to start forwarding frames and generating interrupts. | 
|  | 4544 | */ | 
|  | 4545 | void | 
|  | 4546 | vxge_hw_vpath_enable(struct __vxge_hw_vpath_handle *vp) | 
|  | 4547 | { | 
|  | 4548 | struct __vxge_hw_device *hldev; | 
|  | 4549 | u64 val64; | 
|  | 4550 |  | 
|  | 4551 | hldev = vp->vpath->hldev; | 
|  | 4552 |  | 
|  | 4553 | val64 = VXGE_HW_CMN_RSTHDLR_CFG1_CLR_VPATH_RESET( | 
|  | 4554 | 1 << (16 - vp->vpath->vp_id)); | 
|  | 4555 |  | 
|  | 4556 | __vxge_hw_pio_mem_write32_upper((u32)vxge_bVALn(val64, 0, 32), | 
|  | 4557 | &hldev->common_reg->cmn_rsthdlr_cfg1); | 
|  | 4558 | } | 
|  | 4559 |  | 
|  | 4560 | /* | 
|  | 4561 | * vxge_hw_vpath_stats_enable - Enable vpath h/wstatistics. | 
|  | 4562 | * Enable the DMA vpath statistics. The function is to be called to re-enable | 
|  | 4563 | * the adapter to update stats into the host memory | 
|  | 4564 | */ | 
|  | 4565 | enum vxge_hw_status | 
|  | 4566 | vxge_hw_vpath_stats_enable(struct __vxge_hw_vpath_handle *vp) | 
|  | 4567 | { | 
|  | 4568 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 4569 | struct __vxge_hw_virtualpath *vpath; | 
|  | 4570 |  | 
|  | 4571 | vpath = vp->vpath; | 
|  | 4572 |  | 
|  | 4573 | if (vpath->vp_open == VXGE_HW_VP_NOT_OPEN) { | 
|  | 4574 | status = VXGE_HW_ERR_VPATH_NOT_OPEN; | 
|  | 4575 | goto exit; | 
|  | 4576 | } | 
|  | 4577 |  | 
|  | 4578 | memcpy(vpath->hw_stats_sav, vpath->hw_stats, | 
|  | 4579 | sizeof(struct vxge_hw_vpath_stats_hw_info)); | 
|  | 4580 |  | 
|  | 4581 | status = __vxge_hw_vpath_stats_get(vpath, vpath->hw_stats); | 
|  | 4582 | exit: | 
|  | 4583 | return status; | 
|  | 4584 | } | 
|  | 4585 |  | 
|  | 4586 | /* | 
|  | 4587 | * __vxge_hw_vpath_stats_access - Get the statistics from the given location | 
|  | 4588 | *                           and offset and perform an operation | 
|  | 4589 | */ | 
|  | 4590 | enum vxge_hw_status | 
|  | 4591 | __vxge_hw_vpath_stats_access(struct __vxge_hw_virtualpath *vpath, | 
|  | 4592 | u32 operation, u32 offset, u64 *stat) | 
|  | 4593 | { | 
|  | 4594 | u64 val64; | 
|  | 4595 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 4596 | struct vxge_hw_vpath_reg __iomem *vp_reg; | 
|  | 4597 |  | 
|  | 4598 | if (vpath->vp_open == VXGE_HW_VP_NOT_OPEN) { | 
|  | 4599 | status = VXGE_HW_ERR_VPATH_NOT_OPEN; | 
|  | 4600 | goto vpath_stats_access_exit; | 
|  | 4601 | } | 
|  | 4602 |  | 
|  | 4603 | vp_reg = vpath->vp_reg; | 
|  | 4604 |  | 
|  | 4605 | val64 =  VXGE_HW_XMAC_STATS_ACCESS_CMD_OP(operation) | | 
|  | 4606 | VXGE_HW_XMAC_STATS_ACCESS_CMD_STROBE | | 
|  | 4607 | VXGE_HW_XMAC_STATS_ACCESS_CMD_OFFSET_SEL(offset); | 
|  | 4608 |  | 
|  | 4609 | status = __vxge_hw_pio_mem_write64(val64, | 
|  | 4610 | &vp_reg->xmac_stats_access_cmd, | 
|  | 4611 | VXGE_HW_XMAC_STATS_ACCESS_CMD_STROBE, | 
|  | 4612 | vpath->hldev->config.device_poll_millis); | 
|  | 4613 |  | 
|  | 4614 | if ((status == VXGE_HW_OK) && (operation == VXGE_HW_STATS_OP_READ)) | 
|  | 4615 | *stat = readq(&vp_reg->xmac_stats_access_data); | 
|  | 4616 | else | 
|  | 4617 | *stat = 0; | 
|  | 4618 |  | 
|  | 4619 | vpath_stats_access_exit: | 
|  | 4620 | return status; | 
|  | 4621 | } | 
|  | 4622 |  | 
|  | 4623 | /* | 
|  | 4624 | * __vxge_hw_vpath_xmac_tx_stats_get - Get the TX Statistics of a vpath | 
|  | 4625 | */ | 
|  | 4626 | enum vxge_hw_status | 
|  | 4627 | __vxge_hw_vpath_xmac_tx_stats_get( | 
|  | 4628 | struct __vxge_hw_virtualpath *vpath, | 
|  | 4629 | struct vxge_hw_xmac_vpath_tx_stats *vpath_tx_stats) | 
|  | 4630 | { | 
|  | 4631 | u64 *val64; | 
|  | 4632 | int i; | 
|  | 4633 | u32 offset = VXGE_HW_STATS_VPATH_TX_OFFSET; | 
|  | 4634 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 4635 |  | 
|  | 4636 | val64 = (u64 *) vpath_tx_stats; | 
|  | 4637 |  | 
|  | 4638 | if (vpath->vp_open == VXGE_HW_VP_NOT_OPEN) { | 
|  | 4639 | status = VXGE_HW_ERR_VPATH_NOT_OPEN; | 
|  | 4640 | goto exit; | 
|  | 4641 | } | 
|  | 4642 |  | 
|  | 4643 | for (i = 0; i < sizeof(struct vxge_hw_xmac_vpath_tx_stats) / 8; i++) { | 
|  | 4644 | status = __vxge_hw_vpath_stats_access(vpath, | 
|  | 4645 | VXGE_HW_STATS_OP_READ, | 
|  | 4646 | offset, val64); | 
|  | 4647 | if (status != VXGE_HW_OK) | 
|  | 4648 | goto exit; | 
|  | 4649 | offset++; | 
|  | 4650 | val64++; | 
|  | 4651 | } | 
|  | 4652 | exit: | 
|  | 4653 | return status; | 
|  | 4654 | } | 
|  | 4655 |  | 
|  | 4656 | /* | 
|  | 4657 | * __vxge_hw_vpath_xmac_rx_stats_get - Get the RX Statistics of a vpath | 
|  | 4658 | */ | 
|  | 4659 | enum vxge_hw_status | 
|  | 4660 | __vxge_hw_vpath_xmac_rx_stats_get(struct __vxge_hw_virtualpath *vpath, | 
|  | 4661 | struct vxge_hw_xmac_vpath_rx_stats *vpath_rx_stats) | 
|  | 4662 | { | 
|  | 4663 | u64 *val64; | 
|  | 4664 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 4665 | int i; | 
|  | 4666 | u32 offset = VXGE_HW_STATS_VPATH_RX_OFFSET; | 
|  | 4667 | val64 = (u64 *) vpath_rx_stats; | 
|  | 4668 |  | 
|  | 4669 | if (vpath->vp_open == VXGE_HW_VP_NOT_OPEN) { | 
|  | 4670 | status = VXGE_HW_ERR_VPATH_NOT_OPEN; | 
|  | 4671 | goto exit; | 
|  | 4672 | } | 
|  | 4673 | for (i = 0; i < sizeof(struct vxge_hw_xmac_vpath_rx_stats) / 8; i++) { | 
|  | 4674 | status = __vxge_hw_vpath_stats_access(vpath, | 
|  | 4675 | VXGE_HW_STATS_OP_READ, | 
|  | 4676 | offset >> 3, val64); | 
|  | 4677 | if (status != VXGE_HW_OK) | 
|  | 4678 | goto exit; | 
|  | 4679 |  | 
|  | 4680 | offset += 8; | 
|  | 4681 | val64++; | 
|  | 4682 | } | 
|  | 4683 | exit: | 
|  | 4684 | return status; | 
|  | 4685 | } | 
|  | 4686 |  | 
|  | 4687 | /* | 
|  | 4688 | * __vxge_hw_vpath_stats_get - Get the vpath hw statistics. | 
|  | 4689 | */ | 
|  | 4690 | enum vxge_hw_status __vxge_hw_vpath_stats_get( | 
|  | 4691 | struct __vxge_hw_virtualpath *vpath, | 
|  | 4692 | struct vxge_hw_vpath_stats_hw_info *hw_stats) | 
|  | 4693 | { | 
|  | 4694 | u64 val64; | 
|  | 4695 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 4696 | struct vxge_hw_vpath_reg __iomem *vp_reg; | 
|  | 4697 |  | 
|  | 4698 | if (vpath->vp_open == VXGE_HW_VP_NOT_OPEN) { | 
|  | 4699 | status = VXGE_HW_ERR_VPATH_NOT_OPEN; | 
|  | 4700 | goto exit; | 
|  | 4701 | } | 
|  | 4702 | vp_reg = vpath->vp_reg; | 
|  | 4703 |  | 
|  | 4704 | val64 = readq(&vp_reg->vpath_debug_stats0); | 
|  | 4705 | hw_stats->ini_num_mwr_sent = | 
|  | 4706 | (u32)VXGE_HW_VPATH_DEBUG_STATS0_GET_INI_NUM_MWR_SENT(val64); | 
|  | 4707 |  | 
|  | 4708 | val64 = readq(&vp_reg->vpath_debug_stats1); | 
|  | 4709 | hw_stats->ini_num_mrd_sent = | 
|  | 4710 | (u32)VXGE_HW_VPATH_DEBUG_STATS1_GET_INI_NUM_MRD_SENT(val64); | 
|  | 4711 |  | 
|  | 4712 | val64 = readq(&vp_reg->vpath_debug_stats2); | 
|  | 4713 | hw_stats->ini_num_cpl_rcvd = | 
|  | 4714 | (u32)VXGE_HW_VPATH_DEBUG_STATS2_GET_INI_NUM_CPL_RCVD(val64); | 
|  | 4715 |  | 
|  | 4716 | val64 = readq(&vp_reg->vpath_debug_stats3); | 
|  | 4717 | hw_stats->ini_num_mwr_byte_sent = | 
|  | 4718 | VXGE_HW_VPATH_DEBUG_STATS3_GET_INI_NUM_MWR_BYTE_SENT(val64); | 
|  | 4719 |  | 
|  | 4720 | val64 = readq(&vp_reg->vpath_debug_stats4); | 
|  | 4721 | hw_stats->ini_num_cpl_byte_rcvd = | 
|  | 4722 | VXGE_HW_VPATH_DEBUG_STATS4_GET_INI_NUM_CPL_BYTE_RCVD(val64); | 
|  | 4723 |  | 
|  | 4724 | val64 = readq(&vp_reg->vpath_debug_stats5); | 
|  | 4725 | hw_stats->wrcrdtarb_xoff = | 
|  | 4726 | (u32)VXGE_HW_VPATH_DEBUG_STATS5_GET_WRCRDTARB_XOFF(val64); | 
|  | 4727 |  | 
|  | 4728 | val64 = readq(&vp_reg->vpath_debug_stats6); | 
|  | 4729 | hw_stats->rdcrdtarb_xoff = | 
|  | 4730 | (u32)VXGE_HW_VPATH_DEBUG_STATS6_GET_RDCRDTARB_XOFF(val64); | 
|  | 4731 |  | 
|  | 4732 | val64 = readq(&vp_reg->vpath_genstats_count01); | 
|  | 4733 | hw_stats->vpath_genstats_count0 = | 
|  | 4734 | (u32)VXGE_HW_VPATH_GENSTATS_COUNT01_GET_PPIF_VPATH_GENSTATS_COUNT0( | 
|  | 4735 | val64); | 
|  | 4736 |  | 
|  | 4737 | val64 = readq(&vp_reg->vpath_genstats_count01); | 
|  | 4738 | hw_stats->vpath_genstats_count1 = | 
|  | 4739 | (u32)VXGE_HW_VPATH_GENSTATS_COUNT01_GET_PPIF_VPATH_GENSTATS_COUNT1( | 
|  | 4740 | val64); | 
|  | 4741 |  | 
|  | 4742 | val64 = readq(&vp_reg->vpath_genstats_count23); | 
|  | 4743 | hw_stats->vpath_genstats_count2 = | 
|  | 4744 | (u32)VXGE_HW_VPATH_GENSTATS_COUNT23_GET_PPIF_VPATH_GENSTATS_COUNT2( | 
|  | 4745 | val64); | 
|  | 4746 |  | 
|  | 4747 | val64 = readq(&vp_reg->vpath_genstats_count01); | 
|  | 4748 | hw_stats->vpath_genstats_count3 = | 
|  | 4749 | (u32)VXGE_HW_VPATH_GENSTATS_COUNT23_GET_PPIF_VPATH_GENSTATS_COUNT3( | 
|  | 4750 | val64); | 
|  | 4751 |  | 
|  | 4752 | val64 = readq(&vp_reg->vpath_genstats_count4); | 
|  | 4753 | hw_stats->vpath_genstats_count4 = | 
|  | 4754 | (u32)VXGE_HW_VPATH_GENSTATS_COUNT4_GET_PPIF_VPATH_GENSTATS_COUNT4( | 
|  | 4755 | val64); | 
|  | 4756 |  | 
|  | 4757 | val64 = readq(&vp_reg->vpath_genstats_count5); | 
|  | 4758 | hw_stats->vpath_genstats_count5 = | 
|  | 4759 | (u32)VXGE_HW_VPATH_GENSTATS_COUNT5_GET_PPIF_VPATH_GENSTATS_COUNT5( | 
|  | 4760 | val64); | 
|  | 4761 |  | 
|  | 4762 | status = __vxge_hw_vpath_xmac_tx_stats_get(vpath, &hw_stats->tx_stats); | 
|  | 4763 | if (status != VXGE_HW_OK) | 
|  | 4764 | goto exit; | 
|  | 4765 |  | 
|  | 4766 | status = __vxge_hw_vpath_xmac_rx_stats_get(vpath, &hw_stats->rx_stats); | 
|  | 4767 | if (status != VXGE_HW_OK) | 
|  | 4768 | goto exit; | 
|  | 4769 |  | 
|  | 4770 | VXGE_HW_VPATH_STATS_PIO_READ( | 
|  | 4771 | VXGE_HW_STATS_VPATH_PROG_EVENT_VNUM0_OFFSET); | 
|  | 4772 |  | 
|  | 4773 | hw_stats->prog_event_vnum0 = | 
|  | 4774 | (u32)VXGE_HW_STATS_GET_VPATH_PROG_EVENT_VNUM0(val64); | 
|  | 4775 |  | 
|  | 4776 | hw_stats->prog_event_vnum1 = | 
|  | 4777 | (u32)VXGE_HW_STATS_GET_VPATH_PROG_EVENT_VNUM1(val64); | 
|  | 4778 |  | 
|  | 4779 | VXGE_HW_VPATH_STATS_PIO_READ( | 
|  | 4780 | VXGE_HW_STATS_VPATH_PROG_EVENT_VNUM2_OFFSET); | 
|  | 4781 |  | 
|  | 4782 | hw_stats->prog_event_vnum2 = | 
|  | 4783 | (u32)VXGE_HW_STATS_GET_VPATH_PROG_EVENT_VNUM2(val64); | 
|  | 4784 |  | 
|  | 4785 | hw_stats->prog_event_vnum3 = | 
|  | 4786 | (u32)VXGE_HW_STATS_GET_VPATH_PROG_EVENT_VNUM3(val64); | 
|  | 4787 |  | 
|  | 4788 | val64 = readq(&vp_reg->rx_multi_cast_stats); | 
|  | 4789 | hw_stats->rx_multi_cast_frame_discard = | 
|  | 4790 | (u16)VXGE_HW_RX_MULTI_CAST_STATS_GET_FRAME_DISCARD(val64); | 
|  | 4791 |  | 
|  | 4792 | val64 = readq(&vp_reg->rx_frm_transferred); | 
|  | 4793 | hw_stats->rx_frm_transferred = | 
|  | 4794 | (u32)VXGE_HW_RX_FRM_TRANSFERRED_GET_RX_FRM_TRANSFERRED(val64); | 
|  | 4795 |  | 
|  | 4796 | val64 = readq(&vp_reg->rxd_returned); | 
|  | 4797 | hw_stats->rxd_returned = | 
|  | 4798 | (u16)VXGE_HW_RXD_RETURNED_GET_RXD_RETURNED(val64); | 
|  | 4799 |  | 
|  | 4800 | val64 = readq(&vp_reg->dbg_stats_rx_mpa); | 
|  | 4801 | hw_stats->rx_mpa_len_fail_frms = | 
|  | 4802 | (u16)VXGE_HW_DBG_STATS_GET_RX_MPA_LEN_FAIL_FRMS(val64); | 
|  | 4803 | hw_stats->rx_mpa_mrk_fail_frms = | 
|  | 4804 | (u16)VXGE_HW_DBG_STATS_GET_RX_MPA_MRK_FAIL_FRMS(val64); | 
|  | 4805 | hw_stats->rx_mpa_crc_fail_frms = | 
|  | 4806 | (u16)VXGE_HW_DBG_STATS_GET_RX_MPA_CRC_FAIL_FRMS(val64); | 
|  | 4807 |  | 
|  | 4808 | val64 = readq(&vp_reg->dbg_stats_rx_fau); | 
|  | 4809 | hw_stats->rx_permitted_frms = | 
|  | 4810 | (u16)VXGE_HW_DBG_STATS_GET_RX_FAU_RX_PERMITTED_FRMS(val64); | 
|  | 4811 | hw_stats->rx_vp_reset_discarded_frms = | 
|  | 4812 | (u16)VXGE_HW_DBG_STATS_GET_RX_FAU_RX_VP_RESET_DISCARDED_FRMS(val64); | 
|  | 4813 | hw_stats->rx_wol_frms = | 
|  | 4814 | (u16)VXGE_HW_DBG_STATS_GET_RX_FAU_RX_WOL_FRMS(val64); | 
|  | 4815 |  | 
|  | 4816 | val64 = readq(&vp_reg->tx_vp_reset_discarded_frms); | 
|  | 4817 | hw_stats->tx_vp_reset_discarded_frms = | 
|  | 4818 | (u16)VXGE_HW_TX_VP_RESET_DISCARDED_FRMS_GET_TX_VP_RESET_DISCARDED_FRMS( | 
|  | 4819 | val64); | 
|  | 4820 | exit: | 
|  | 4821 | return status; | 
|  | 4822 | } | 
|  | 4823 |  | 
|  | 4824 | /* | 
|  | 4825 | * __vxge_hw_blockpool_create - Create block pool | 
|  | 4826 | */ | 
|  | 4827 |  | 
|  | 4828 | enum vxge_hw_status | 
|  | 4829 | __vxge_hw_blockpool_create(struct __vxge_hw_device *hldev, | 
|  | 4830 | struct __vxge_hw_blockpool *blockpool, | 
|  | 4831 | u32 pool_size, | 
|  | 4832 | u32 pool_max) | 
|  | 4833 | { | 
|  | 4834 | u32 i; | 
|  | 4835 | struct __vxge_hw_blockpool_entry *entry = NULL; | 
|  | 4836 | void *memblock; | 
|  | 4837 | dma_addr_t dma_addr; | 
|  | 4838 | struct pci_dev *dma_handle; | 
|  | 4839 | struct pci_dev *acc_handle; | 
|  | 4840 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 4841 |  | 
|  | 4842 | if (blockpool == NULL) { | 
|  | 4843 | status = VXGE_HW_FAIL; | 
|  | 4844 | goto blockpool_create_exit; | 
|  | 4845 | } | 
|  | 4846 |  | 
|  | 4847 | blockpool->hldev = hldev; | 
|  | 4848 | blockpool->block_size = VXGE_HW_BLOCK_SIZE; | 
|  | 4849 | blockpool->pool_size = 0; | 
|  | 4850 | blockpool->pool_max = pool_max; | 
|  | 4851 | blockpool->req_out = 0; | 
|  | 4852 |  | 
|  | 4853 | INIT_LIST_HEAD(&blockpool->free_block_list); | 
|  | 4854 | INIT_LIST_HEAD(&blockpool->free_entry_list); | 
|  | 4855 |  | 
|  | 4856 | for (i = 0; i < pool_size + pool_max; i++) { | 
|  | 4857 | entry = kzalloc(sizeof(struct __vxge_hw_blockpool_entry), | 
|  | 4858 | GFP_KERNEL); | 
|  | 4859 | if (entry == NULL) { | 
|  | 4860 | __vxge_hw_blockpool_destroy(blockpool); | 
|  | 4861 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 4862 | goto blockpool_create_exit; | 
|  | 4863 | } | 
|  | 4864 | list_add(&entry->item, &blockpool->free_entry_list); | 
|  | 4865 | } | 
|  | 4866 |  | 
|  | 4867 | for (i = 0; i < pool_size; i++) { | 
|  | 4868 |  | 
|  | 4869 | memblock = vxge_os_dma_malloc( | 
|  | 4870 | hldev->pdev, | 
|  | 4871 | VXGE_HW_BLOCK_SIZE, | 
|  | 4872 | &dma_handle, | 
|  | 4873 | &acc_handle); | 
|  | 4874 |  | 
|  | 4875 | if (memblock == NULL) { | 
|  | 4876 | __vxge_hw_blockpool_destroy(blockpool); | 
|  | 4877 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 4878 | goto blockpool_create_exit; | 
|  | 4879 | } | 
|  | 4880 |  | 
|  | 4881 | dma_addr = pci_map_single(hldev->pdev, memblock, | 
|  | 4882 | VXGE_HW_BLOCK_SIZE, PCI_DMA_BIDIRECTIONAL); | 
|  | 4883 |  | 
|  | 4884 | if (unlikely(pci_dma_mapping_error(hldev->pdev, | 
|  | 4885 | dma_addr))) { | 
|  | 4886 |  | 
|  | 4887 | vxge_os_dma_free(hldev->pdev, memblock, &acc_handle); | 
|  | 4888 | __vxge_hw_blockpool_destroy(blockpool); | 
|  | 4889 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 4890 | goto blockpool_create_exit; | 
|  | 4891 | } | 
|  | 4892 |  | 
|  | 4893 | if (!list_empty(&blockpool->free_entry_list)) | 
|  | 4894 | entry = (struct __vxge_hw_blockpool_entry *) | 
|  | 4895 | list_first_entry(&blockpool->free_entry_list, | 
|  | 4896 | struct __vxge_hw_blockpool_entry, | 
|  | 4897 | item); | 
|  | 4898 |  | 
|  | 4899 | if (entry == NULL) | 
|  | 4900 | entry = | 
|  | 4901 | kzalloc(sizeof(struct __vxge_hw_blockpool_entry), | 
|  | 4902 | GFP_KERNEL); | 
|  | 4903 | if (entry != NULL) { | 
|  | 4904 | list_del(&entry->item); | 
|  | 4905 | entry->length = VXGE_HW_BLOCK_SIZE; | 
|  | 4906 | entry->memblock = memblock; | 
|  | 4907 | entry->dma_addr = dma_addr; | 
|  | 4908 | entry->acc_handle = acc_handle; | 
|  | 4909 | entry->dma_handle = dma_handle; | 
|  | 4910 | list_add(&entry->item, | 
|  | 4911 | &blockpool->free_block_list); | 
|  | 4912 | blockpool->pool_size++; | 
|  | 4913 | } else { | 
|  | 4914 | __vxge_hw_blockpool_destroy(blockpool); | 
|  | 4915 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 4916 | goto blockpool_create_exit; | 
|  | 4917 | } | 
|  | 4918 | } | 
|  | 4919 |  | 
|  | 4920 | blockpool_create_exit: | 
|  | 4921 | return status; | 
|  | 4922 | } | 
|  | 4923 |  | 
|  | 4924 | /* | 
|  | 4925 | * __vxge_hw_blockpool_destroy - Deallocates the block pool | 
|  | 4926 | */ | 
|  | 4927 |  | 
|  | 4928 | void __vxge_hw_blockpool_destroy(struct __vxge_hw_blockpool *blockpool) | 
|  | 4929 | { | 
|  | 4930 |  | 
|  | 4931 | struct __vxge_hw_device *hldev; | 
|  | 4932 | struct list_head *p, *n; | 
|  | 4933 | u16 ret; | 
|  | 4934 |  | 
|  | 4935 | if (blockpool == NULL) { | 
|  | 4936 | ret = 1; | 
|  | 4937 | goto exit; | 
|  | 4938 | } | 
|  | 4939 |  | 
|  | 4940 | hldev = blockpool->hldev; | 
|  | 4941 |  | 
|  | 4942 | list_for_each_safe(p, n, &blockpool->free_block_list) { | 
|  | 4943 |  | 
|  | 4944 | pci_unmap_single(hldev->pdev, | 
|  | 4945 | ((struct __vxge_hw_blockpool_entry *)p)->dma_addr, | 
|  | 4946 | ((struct __vxge_hw_blockpool_entry *)p)->length, | 
|  | 4947 | PCI_DMA_BIDIRECTIONAL); | 
|  | 4948 |  | 
|  | 4949 | vxge_os_dma_free(hldev->pdev, | 
|  | 4950 | ((struct __vxge_hw_blockpool_entry *)p)->memblock, | 
|  | 4951 | &((struct __vxge_hw_blockpool_entry *) p)->acc_handle); | 
|  | 4952 |  | 
|  | 4953 | list_del( | 
|  | 4954 | &((struct __vxge_hw_blockpool_entry *)p)->item); | 
|  | 4955 | kfree(p); | 
|  | 4956 | blockpool->pool_size--; | 
|  | 4957 | } | 
|  | 4958 |  | 
|  | 4959 | list_for_each_safe(p, n, &blockpool->free_entry_list) { | 
|  | 4960 | list_del( | 
|  | 4961 | &((struct __vxge_hw_blockpool_entry *)p)->item); | 
|  | 4962 | kfree((void *)p); | 
|  | 4963 | } | 
|  | 4964 | ret = 0; | 
|  | 4965 | exit: | 
|  | 4966 | return; | 
|  | 4967 | } | 
|  | 4968 |  | 
|  | 4969 | /* | 
|  | 4970 | * __vxge_hw_blockpool_blocks_add - Request additional blocks | 
|  | 4971 | */ | 
|  | 4972 | static | 
|  | 4973 | void __vxge_hw_blockpool_blocks_add(struct __vxge_hw_blockpool *blockpool) | 
|  | 4974 | { | 
|  | 4975 | u32 nreq = 0, i; | 
|  | 4976 |  | 
|  | 4977 | if ((blockpool->pool_size  +  blockpool->req_out) < | 
|  | 4978 | VXGE_HW_MIN_DMA_BLOCK_POOL_SIZE) { | 
|  | 4979 | nreq = VXGE_HW_INCR_DMA_BLOCK_POOL_SIZE; | 
|  | 4980 | blockpool->req_out += nreq; | 
|  | 4981 | } | 
|  | 4982 |  | 
|  | 4983 | for (i = 0; i < nreq; i++) | 
|  | 4984 | vxge_os_dma_malloc_async( | 
|  | 4985 | ((struct __vxge_hw_device *)blockpool->hldev)->pdev, | 
|  | 4986 | blockpool->hldev, VXGE_HW_BLOCK_SIZE); | 
|  | 4987 | } | 
|  | 4988 |  | 
|  | 4989 | /* | 
|  | 4990 | * __vxge_hw_blockpool_blocks_remove - Free additional blocks | 
|  | 4991 | */ | 
|  | 4992 | static | 
|  | 4993 | void __vxge_hw_blockpool_blocks_remove(struct __vxge_hw_blockpool *blockpool) | 
|  | 4994 | { | 
|  | 4995 | struct list_head *p, *n; | 
|  | 4996 |  | 
|  | 4997 | list_for_each_safe(p, n, &blockpool->free_block_list) { | 
|  | 4998 |  | 
|  | 4999 | if (blockpool->pool_size < blockpool->pool_max) | 
|  | 5000 | break; | 
|  | 5001 |  | 
|  | 5002 | pci_unmap_single( | 
|  | 5003 | ((struct __vxge_hw_device *)blockpool->hldev)->pdev, | 
|  | 5004 | ((struct __vxge_hw_blockpool_entry *)p)->dma_addr, | 
|  | 5005 | ((struct __vxge_hw_blockpool_entry *)p)->length, | 
|  | 5006 | PCI_DMA_BIDIRECTIONAL); | 
|  | 5007 |  | 
|  | 5008 | vxge_os_dma_free( | 
|  | 5009 | ((struct __vxge_hw_device *)blockpool->hldev)->pdev, | 
|  | 5010 | ((struct __vxge_hw_blockpool_entry *)p)->memblock, | 
|  | 5011 | &((struct __vxge_hw_blockpool_entry *)p)->acc_handle); | 
|  | 5012 |  | 
|  | 5013 | list_del(&((struct __vxge_hw_blockpool_entry *)p)->item); | 
|  | 5014 |  | 
|  | 5015 | list_add(p, &blockpool->free_entry_list); | 
|  | 5016 |  | 
|  | 5017 | blockpool->pool_size--; | 
|  | 5018 |  | 
|  | 5019 | } | 
|  | 5020 | } | 
|  | 5021 |  | 
|  | 5022 | /* | 
|  | 5023 | * vxge_hw_blockpool_block_add - callback for vxge_os_dma_malloc_async | 
|  | 5024 | * Adds a block to block pool | 
|  | 5025 | */ | 
|  | 5026 | void vxge_hw_blockpool_block_add( | 
|  | 5027 | struct __vxge_hw_device *devh, | 
|  | 5028 | void *block_addr, | 
|  | 5029 | u32 length, | 
|  | 5030 | struct pci_dev *dma_h, | 
|  | 5031 | struct pci_dev *acc_handle) | 
|  | 5032 | { | 
|  | 5033 | struct __vxge_hw_blockpool  *blockpool; | 
|  | 5034 | struct __vxge_hw_blockpool_entry  *entry = NULL; | 
|  | 5035 | dma_addr_t dma_addr; | 
|  | 5036 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 5037 | u32 req_out; | 
|  | 5038 |  | 
|  | 5039 | blockpool = &devh->block_pool; | 
|  | 5040 |  | 
|  | 5041 | if (block_addr == NULL) { | 
|  | 5042 | blockpool->req_out--; | 
|  | 5043 | status = VXGE_HW_FAIL; | 
|  | 5044 | goto exit; | 
|  | 5045 | } | 
|  | 5046 |  | 
|  | 5047 | dma_addr = pci_map_single(devh->pdev, block_addr, length, | 
|  | 5048 | PCI_DMA_BIDIRECTIONAL); | 
|  | 5049 |  | 
|  | 5050 | if (unlikely(pci_dma_mapping_error(devh->pdev, dma_addr))) { | 
|  | 5051 |  | 
|  | 5052 | vxge_os_dma_free(devh->pdev, block_addr, &acc_handle); | 
|  | 5053 | blockpool->req_out--; | 
|  | 5054 | status = VXGE_HW_FAIL; | 
|  | 5055 | goto exit; | 
|  | 5056 | } | 
|  | 5057 |  | 
|  | 5058 |  | 
|  | 5059 | if (!list_empty(&blockpool->free_entry_list)) | 
|  | 5060 | entry = (struct __vxge_hw_blockpool_entry *) | 
|  | 5061 | list_first_entry(&blockpool->free_entry_list, | 
|  | 5062 | struct __vxge_hw_blockpool_entry, | 
|  | 5063 | item); | 
|  | 5064 |  | 
|  | 5065 | if (entry == NULL) | 
|  | 5066 | entry = (struct __vxge_hw_blockpool_entry *) | 
|  | 5067 | vmalloc(sizeof(struct __vxge_hw_blockpool_entry)); | 
|  | 5068 | else | 
|  | 5069 | list_del(&entry->item); | 
|  | 5070 |  | 
|  | 5071 | if (entry != NULL) { | 
|  | 5072 | entry->length = length; | 
|  | 5073 | entry->memblock = block_addr; | 
|  | 5074 | entry->dma_addr = dma_addr; | 
|  | 5075 | entry->acc_handle = acc_handle; | 
|  | 5076 | entry->dma_handle = dma_h; | 
|  | 5077 | list_add(&entry->item, &blockpool->free_block_list); | 
|  | 5078 | blockpool->pool_size++; | 
|  | 5079 | status = VXGE_HW_OK; | 
|  | 5080 | } else | 
|  | 5081 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 5082 |  | 
|  | 5083 | blockpool->req_out--; | 
|  | 5084 |  | 
|  | 5085 | req_out = blockpool->req_out; | 
|  | 5086 | exit: | 
|  | 5087 | return; | 
|  | 5088 | } | 
|  | 5089 |  | 
|  | 5090 | /* | 
|  | 5091 | * __vxge_hw_blockpool_malloc - Allocate a memory block from pool | 
|  | 5092 | * Allocates a block of memory of given size, either from block pool | 
|  | 5093 | * or by calling vxge_os_dma_malloc() | 
|  | 5094 | */ | 
|  | 5095 | void * | 
|  | 5096 | __vxge_hw_blockpool_malloc(struct __vxge_hw_device *devh, u32 size, | 
|  | 5097 | struct vxge_hw_mempool_dma *dma_object) | 
|  | 5098 | { | 
|  | 5099 | struct __vxge_hw_blockpool_entry *entry = NULL; | 
|  | 5100 | struct __vxge_hw_blockpool  *blockpool; | 
|  | 5101 | void *memblock = NULL; | 
|  | 5102 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 5103 |  | 
|  | 5104 | blockpool = &devh->block_pool; | 
|  | 5105 |  | 
|  | 5106 | if (size != blockpool->block_size) { | 
|  | 5107 |  | 
|  | 5108 | memblock = vxge_os_dma_malloc(devh->pdev, size, | 
|  | 5109 | &dma_object->handle, | 
|  | 5110 | &dma_object->acc_handle); | 
|  | 5111 |  | 
|  | 5112 | if (memblock == NULL) { | 
|  | 5113 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 5114 | goto exit; | 
|  | 5115 | } | 
|  | 5116 |  | 
|  | 5117 | dma_object->addr = pci_map_single(devh->pdev, memblock, size, | 
|  | 5118 | PCI_DMA_BIDIRECTIONAL); | 
|  | 5119 |  | 
|  | 5120 | if (unlikely(pci_dma_mapping_error(devh->pdev, | 
|  | 5121 | dma_object->addr))) { | 
|  | 5122 | vxge_os_dma_free(devh->pdev, memblock, | 
|  | 5123 | &dma_object->acc_handle); | 
|  | 5124 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 5125 | goto exit; | 
|  | 5126 | } | 
|  | 5127 |  | 
|  | 5128 | } else { | 
|  | 5129 |  | 
|  | 5130 | if (!list_empty(&blockpool->free_block_list)) | 
|  | 5131 | entry = (struct __vxge_hw_blockpool_entry *) | 
|  | 5132 | list_first_entry(&blockpool->free_block_list, | 
|  | 5133 | struct __vxge_hw_blockpool_entry, | 
|  | 5134 | item); | 
|  | 5135 |  | 
|  | 5136 | if (entry != NULL) { | 
|  | 5137 | list_del(&entry->item); | 
|  | 5138 | dma_object->addr = entry->dma_addr; | 
|  | 5139 | dma_object->handle = entry->dma_handle; | 
|  | 5140 | dma_object->acc_handle = entry->acc_handle; | 
|  | 5141 | memblock = entry->memblock; | 
|  | 5142 |  | 
|  | 5143 | list_add(&entry->item, | 
|  | 5144 | &blockpool->free_entry_list); | 
|  | 5145 | blockpool->pool_size--; | 
|  | 5146 | } | 
|  | 5147 |  | 
|  | 5148 | if (memblock != NULL) | 
|  | 5149 | __vxge_hw_blockpool_blocks_add(blockpool); | 
|  | 5150 | } | 
|  | 5151 | exit: | 
|  | 5152 | return memblock; | 
|  | 5153 | } | 
|  | 5154 |  | 
|  | 5155 | /* | 
|  | 5156 | * __vxge_hw_blockpool_free - Frees the memory allcoated with | 
|  | 5157 | __vxge_hw_blockpool_malloc | 
|  | 5158 | */ | 
|  | 5159 | void | 
|  | 5160 | __vxge_hw_blockpool_free(struct __vxge_hw_device *devh, | 
|  | 5161 | void *memblock, u32 size, | 
|  | 5162 | struct vxge_hw_mempool_dma *dma_object) | 
|  | 5163 | { | 
|  | 5164 | struct __vxge_hw_blockpool_entry *entry = NULL; | 
|  | 5165 | struct __vxge_hw_blockpool  *blockpool; | 
|  | 5166 | enum vxge_hw_status status = VXGE_HW_OK; | 
|  | 5167 |  | 
|  | 5168 | blockpool = &devh->block_pool; | 
|  | 5169 |  | 
|  | 5170 | if (size != blockpool->block_size) { | 
|  | 5171 | pci_unmap_single(devh->pdev, dma_object->addr, size, | 
|  | 5172 | PCI_DMA_BIDIRECTIONAL); | 
|  | 5173 | vxge_os_dma_free(devh->pdev, memblock, &dma_object->acc_handle); | 
|  | 5174 | } else { | 
|  | 5175 |  | 
|  | 5176 | if (!list_empty(&blockpool->free_entry_list)) | 
|  | 5177 | entry = (struct __vxge_hw_blockpool_entry *) | 
|  | 5178 | list_first_entry(&blockpool->free_entry_list, | 
|  | 5179 | struct __vxge_hw_blockpool_entry, | 
|  | 5180 | item); | 
|  | 5181 |  | 
|  | 5182 | if (entry == NULL) | 
|  | 5183 | entry = (struct __vxge_hw_blockpool_entry *) | 
|  | 5184 | vmalloc(sizeof( | 
|  | 5185 | struct __vxge_hw_blockpool_entry)); | 
|  | 5186 | else | 
|  | 5187 | list_del(&entry->item); | 
|  | 5188 |  | 
|  | 5189 | if (entry != NULL) { | 
|  | 5190 | entry->length = size; | 
|  | 5191 | entry->memblock = memblock; | 
|  | 5192 | entry->dma_addr = dma_object->addr; | 
|  | 5193 | entry->acc_handle = dma_object->acc_handle; | 
|  | 5194 | entry->dma_handle = dma_object->handle; | 
|  | 5195 | list_add(&entry->item, | 
|  | 5196 | &blockpool->free_block_list); | 
|  | 5197 | blockpool->pool_size++; | 
|  | 5198 | status = VXGE_HW_OK; | 
|  | 5199 | } else | 
|  | 5200 | status = VXGE_HW_ERR_OUT_OF_MEMORY; | 
|  | 5201 |  | 
|  | 5202 | if (status == VXGE_HW_OK) | 
|  | 5203 | __vxge_hw_blockpool_blocks_remove(blockpool); | 
|  | 5204 | } | 
|  | 5205 |  | 
|  | 5206 | return; | 
|  | 5207 | } | 
|  | 5208 |  | 
|  | 5209 | /* | 
|  | 5210 | * __vxge_hw_blockpool_block_allocate - Allocates a block from block pool | 
|  | 5211 | * This function allocates a block from block pool or from the system | 
|  | 5212 | */ | 
|  | 5213 | struct __vxge_hw_blockpool_entry * | 
|  | 5214 | __vxge_hw_blockpool_block_allocate(struct __vxge_hw_device *devh, u32 size) | 
|  | 5215 | { | 
|  | 5216 | struct __vxge_hw_blockpool_entry *entry = NULL; | 
|  | 5217 | struct __vxge_hw_blockpool  *blockpool; | 
|  | 5218 |  | 
|  | 5219 | blockpool = &devh->block_pool; | 
|  | 5220 |  | 
|  | 5221 | if (size == blockpool->block_size) { | 
|  | 5222 |  | 
|  | 5223 | if (!list_empty(&blockpool->free_block_list)) | 
|  | 5224 | entry = (struct __vxge_hw_blockpool_entry *) | 
|  | 5225 | list_first_entry(&blockpool->free_block_list, | 
|  | 5226 | struct __vxge_hw_blockpool_entry, | 
|  | 5227 | item); | 
|  | 5228 |  | 
|  | 5229 | if (entry != NULL) { | 
|  | 5230 | list_del(&entry->item); | 
|  | 5231 | blockpool->pool_size--; | 
|  | 5232 | } | 
|  | 5233 | } | 
|  | 5234 |  | 
|  | 5235 | if (entry != NULL) | 
|  | 5236 | __vxge_hw_blockpool_blocks_add(blockpool); | 
|  | 5237 |  | 
|  | 5238 | return entry; | 
|  | 5239 | } | 
|  | 5240 |  | 
|  | 5241 | /* | 
|  | 5242 | * __vxge_hw_blockpool_block_free - Frees a block from block pool | 
|  | 5243 | * @devh: Hal device | 
|  | 5244 | * @entry: Entry of block to be freed | 
|  | 5245 | * | 
|  | 5246 | * This function frees a block from block pool | 
|  | 5247 | */ | 
|  | 5248 | void | 
|  | 5249 | __vxge_hw_blockpool_block_free(struct __vxge_hw_device *devh, | 
|  | 5250 | struct __vxge_hw_blockpool_entry *entry) | 
|  | 5251 | { | 
|  | 5252 | struct __vxge_hw_blockpool  *blockpool; | 
|  | 5253 |  | 
|  | 5254 | blockpool = &devh->block_pool; | 
|  | 5255 |  | 
|  | 5256 | if (entry->length == blockpool->block_size) { | 
|  | 5257 | list_add(&entry->item, &blockpool->free_block_list); | 
|  | 5258 | blockpool->pool_size++; | 
|  | 5259 | } | 
|  | 5260 |  | 
|  | 5261 | __vxge_hw_blockpool_blocks_remove(blockpool); | 
|  | 5262 |  | 
|  | 5263 | return; | 
|  | 5264 | } |